Function: control.«no<n».folloiitr 



* Description: 

* This function 8«tt th« ovcrride_control^mode to no over ride so that 

* th« engine follows ths scctlsrator demand. 

Static void control engine fotlower(void) 
i 

•define POSITIVE PEDAL TRAMSITIOH TIME 25 /* 250 MSEC V 
idefine lii£GATIVE"PEDAL"TRAMSIT!OM.TIME 40 /• 400 MSEC */ 



engine_status = ENGIME_FOLL0UER_MC0E; 

if (<accelerator_pedaljX3sition >■ 5) && /* positive pedal transition */ 
(accelerator jjedal_position_old <» 4) && 
(low speed latch » FALSE)) 

< 

posit ive^pedal trans a TRUE; 

xero flywheel trq^time » POSITIVE PEDAL TRANSITIOM^TIME; 
if (2ero_flywheel_trq_ti»er >■ NEGATIVE,PE0AL_TRAMSITIOII_TIMC) 
zero flywheel trq^tiroer » 0; 

> 

else 
< 

if ((accelerator_pedaljx)sition <» 4) && /* negative pedal transition V 
(accelerator j)edal^sition old >= 5) && 
(low speed latch «» FALSE))" 

i 

rero_flywheeLtrq_tiine = NEGATIVE.PEDALJRANSITION JIME; 
zero'f lywheel"trq_timer =» 0; 

> 

if ((zero^f lywheel_trq_timer < zero^f lywheel.trq_time) && 

(current gear > 1) M (current gear < 10) U (low_speed_latch " FALSE)) 

( 

engine control « TORQUE CONTROL; 
cofflmandJTd = C_ETC1^0VERSPEED; 

desired"enginej5Ct_trq » needed _percent_for_zero_f lywheel_trq; 

if (actual_enginejxt_trq < (needed_percent_for_zero_f lywheel^trq ♦ 5)); 
zero flywheel trq_tTmer++; 

> 

else 
i 

if ((positivejjedal trans == TRUE) && (low speed latch == FALSE)) 
i 

positivejjedal trans » FALSE; 

engine.coaraancte • ENCIHE.RECOVBIY; /* engine: finish torque return */ 

control engine recovery <T; 

> 

else 
( 

engine control « OVERRIDE DISABLED; 
cofimand ETC1 - C ETC1 HORMAL; 

> 

> 

/* if predip mode had been forced, this is the place to clear its flag. V 
/* But only clear it if the pedal is depressed. This is for the case when */ 
/* a false confirmed gear is seen but the driver actually is coasting down. */ 
if (accelerator _pedal jjosition > 4) 
forcedj>redip » FALSE; 

> 

«pragma EJECT 



♦ Function: control^engi needle 

* - - 

♦ Oescriptfon: 

* This fvKtion stts the engine controls for the idle mode. 
* 

static void control engine idle(void) 

engine.control » OVERRIDE OrSASLED; 
coflinand.ETCI « C_ETC1_W0RHAL; 

engine status » ENGINE lOlE HCX)E; 
> " 

fpragma EJECT 



* FuKtlon: control.englrw.sttrt 

* O«scriptfon: 

* This function tats th« enotrw controls for the start mode. 

static void control engine start(void) 

engine control « OVERRIOC DISABLED; 
cooinand_ETC1 ■ C_ETC1_M0RHAL; 

engine status * ENGINE STAPT MODE; 
> ' 

ipragma EJECT 



* Function: control^engine^conprtMion^brake 

* * " 

* Description: 

* This function controls the state of the engine compression brake. 

* The brake can be used during i^hifts to speed up the decel rate of 

* the input shaft. 
« 

static void control engine cotnpression br8ke<void> 
< 

if (engine coomunication active ti 

(engine'status » ENgTnE SYNC MODE) && 
(shift type « UPSHIFT) U 
(irput.speed.fi I tered > (gos ♦ 150)) && 
(destination^gear > 1) && 
(destination^gear < 7) M 
(engine_brake_available) && 

((dos^redicted < dos^rdtd lin no jake) || eng_brake assist)) 

< 

eng brake assist » TRUE; 

else 

< 

eng brake assist = FALSE; 
eng_brake_assist « FALSE; /* debug - force false state for now */ 



ipragma EJECT 



Function: deter«ine_9o« 



Oe«crfption: 

This function mulitpiiM th« destination gear ratio times the 
output shaft speed for use in the ORL.CMOS tnodule. 

gos 3 (g)ear * (o)utput (s)peed 



static void determine gos(void) 
< 

/*** determine gos for the destination_gear **V 
Jax « trn_tbl.gear_ratioCdestination_gear ♦ GR_OFS]; 
~cx ■ output^speed^filtered; /* output speed */ 
asm mulu cxdx, bx; /• BIM 8 result V 

asm shrl ~cxdx, #8; /* make SIN 0 •/ 

gos = _cx7 /* BIN 0 */ 

_bx = trn^tbt .gear-ratio Cdestinati on_gear ♦ GR_0FS3; 
^cx « *<uTnt *)&doi_fi I teredo- 
asm mul _cxdx, _bx; 
asm div _cxdx, #256; 
dgos * *(int *)4_cx; 

gos_signed = (signed intXgos); /* allow signed math in other functions*/ 

/*** determine gos for the "current_gear" ***/ 
_bx s trn_tbl,gear_ratioCcurrent_flear ♦ GR_0FS3; 
3cx a output_speed~f i Itered; "/* output speed */ 
asm mulu cxdx, bx; /* BIN 8 result */ 

asm shrl Icxdx, iS; /* make BIN 0 V 

gos_current_gear = _cx; /* BIN 0 */ 



#pragma EJECT 



Function: dtttralne^shiftabUity^v^lablM 



Otscrtptlon^ 

This function filters both the output speed and the rate of change of 
the output speed for use in the shiftability function. This function 
also calulates the rate of change of the input shaft based on the 
filtered value for the rate of change of the output shaft. 

The filters used in this function are required to get a high level of 
stability. The BIN 8 filter used here will provide a much smoother 
output which is needed to filter out driveline oscillations. 

Note: These calculations were placed in this module because it is 
called on a regular 10 msec interval. These calculations should 
be placed in the pr_i_sj.c96 nodule once shiftability is proven. 
These variables are'used in the SEL GEAR.C96 module. 



static void determine shiftability variables(void) 
i 

exp<-wT). T«0.010s */ 



/* LPF coefficients: 

#define OS LPF 248 

#define DOSFKl 249 

#define EPTFKI 252 



/• 0.9691 BIN 8 (0.50Hz) V 
/* 0.9727 BIN 8 (0.44Hz) */ 
/• 0.9844 BIN 8 (0.25Hz) */ 



idefine IS FKI 235 /* 0.9219 BIN 8 (0.??H2) 

fdefine 0S"fK1 236 /* 0.9219 BIN 8 (0.??Hz) 

#define DISFK1 236 /* 0.9219 BIN 8 (0.?7Hz) 



*/ 
*/ 
*/ 



#define LOU_RANGE 
#define BIN 10 



3197 
1024 



/* 3.1224 BIN 10 



Static long dos_f i ltered_bin8; 
static int ept_fi Itered^binS; 

unsigned long is_f i lte^ed__partial_1; 
unsigned long is_f i ltered_partial_2; 
unsigned long os^filtered _partial_1; 
unsigned long os^filtered _partial_2; 

/** create lpf^oujtput_accel **/ 

_bx » *(uint *)4output_speed_accel; 
jox a *(uint *)4lpf_output_acccl - _bx; 
asm mul _cxdx, #OS_LPF; 
asm div ^cxdx, #256; 
_bx •*■« _cx; 

Tpf_output_accel « *(int *)4_bx; 



/* bx = x(n), BIN 0 */ 

/* "cx = y(n-l) - x<n), BIN 0 •/ 

/* cxdx s IC*<...), BIN 8 V 

/* make BIN 0 */ 

/* _bx « x(n) ♦ K*(...), BIN 0 •/ 
/* save acceleration */ 



/** dos_filtered = (dosjiltered * 0OSFIC1) ♦ (lpf_output_accel * (1-0OSFK1) *•/ 



_cxdx ■ *(utong *)&dos_f i ltered_^bin8; 

asm shral _cxdx, #2; 

asm mui .cxdx, HfDOSFKl; 

asm shral _cxdx, #6; 

dos^f iltered_bin8 » *<long *)4_cxdx; 

cx ■ *(uint *)&lpf output accel; 
"bx « 256 - DOSFKI;" 
asm mul .cxdx, .bx; 
dos_filtered_bin8 *(long *)A.cxdx; 



/* BIN 8 */ 
/* BIN 6 ( cx) V 
/* BIN 14 */ 
/* BIN 8 */ 
/* save partial result V 

/* BIN 0 */ 
/* 1 BIN 8 - D0SFK1 */ 
/* BIN 8 V 

/* sun is final result */ 



dos.filtered » (intXdos.f i Itered.bind » 8); /* BIN 0 */ 

/** eng_percent torque filtered » (engj»rcent torque filtered * EPTFKI) ♦ 
(net^engine^^t.trq • (1 -EPTFKI ) *•/ 



_cx « *(uint *)4ept_ff Itered.binS; 

asm mul .cxdx, li^PTFKI; 

asm shral .cxdx, il^; 

ept.fi I tered_bin8 a *(int *)A.cx; 

cx » net engine.pct trq; 
"bx » 256"- EPTFKI; " 
asm nul cxdx, bx; 
ept.fi I tered.bin8 '(int *)*.cx; 



/* BIN 8 */ 
/* BIN 16 V 
/* BIN 8 */ 
/* save partial result */ 

/* BIN 0 V 

/* 1 BIN 8 - EPTFKI */ 
/• BIN 8 V 

/• sua is final result V 



<n9j»rctnt_torqj»^fUt«r«d ■ (char)<«pt.f i iter9d_bin8 » 8); 

/** input_shaft.ftcc«(_calcutftted « dos^fUtered * gear-ratio **/ 

_cx « tm tbl.aMr.ratioCdMtl nation gear ♦ GR 0FS3; /* BIN 8 •/ 
Jm » •<uTnt *)tdot^filt«rtd; " ~ /* BIN 0 */ 

asa «u( .cxdx, bx;' /* BIN 8 */ 

asm shraT _cxcU7 #8; /* BIN 0 V 

ir>put^shaft_acce I ^calculated « *(int *)&_cx; 

/*** calculate filtered input and output shaft speeds for AutoSplit * 

/**• determine os_based_on^rcs variable ***/ 
if (output speed < 1000) 
i 

bx » aux speed; /* BIN 0 */ 

"cx » 8In"10; /• BIN 10 */ 

.ax » LOW_RANGE; /* BIN 10 •/ 

asa oulu _cxdx, _bx; /* make aux.speed BIN 10 */ 

asm divu Icxdx, ~ax; /* divide by low range BIN 10 */ 



OS based on res 



cx; 



/* BIN 0 V 



/** input speed filtered = (input speed filtered * IS.FKl) ♦ 
(input.speed * (l-IS.FKl) **/ 



ax ■ (is filtered binS » 4) ; 
lex « IS_FK1 ; 
asm mulu _axbx« _cx ; 
asm shrl _axbx, #4 ; 
is^filtered _partial_1 = _axbx ; 

cx s input speed ; 
3ax » 256 -"lS_FKl ; 
asm mulu .axbx, _cx ; 
is_f iltered__partial_2 = _axbx ; 



/* BIN 4 
/* BIN 8 
/* BIN 12 
/♦ BIN 8 
/* BIN 8 

/* BIN 0 

/* 1 BIN 8 - IS FK1 
/* BIN 8 
/* BIN 8 



is_f i ltered_bin8 = is.filtered _partial_1 + is_f i lteredj)artial_2 ; 
input^^speed.f iltered = (unsigned int)(is_f i ltered.bin8 » 8); /* BIN 0 



/** output speed filtered = (output speed filtered * OS FKl) ♦ 
" (output_speed * (T-OS_Fici) **/ 



ax = (OS filtered bin8 » 4) ; 
*cx = 0SJK1 ; 
asm mulu _axbx, _cx ; 
asm shrl ~axbx, i4 ; 
os_filteredj5artial_1 = .axbx ; 

#if (0) 
if (output.speed < 250) 
.cx » os.based_on_rcs; 
else * 
#endif 

_cx 3 output_spe«d ; 

_ax » 256 - OS.FKI ; 

asm mulu .axbx, .cx ; 

os.f ilteredj)artTal.2 ■ .axbx ; 



/* BIN 4 
/* BIN 8 
/* BIN 12 
/* BIN 8 
/* BIN 8 



/* BIN 0 



/* BIN 0 



/♦ 1 BIN 8 - OS FKl •/ 
/* BIN 8 " V 

/* BIN 8 */ 



os_f iltered_bin8 ■ 08.fi I tared _^rtial.1 + os.f iltered__partial_2 ; 
output.speed.filtered » (unsigned int)(os.f i ltered.bin8 » 8); /* BIN 0 



/** input.speed.accel.fi I tered « (input.speed.accel.fi I tered * DISFKI) + (ir^ut.shaft.accel * (1-0ISFK1) 



.cxdx ■ *(ulong *)Wis.f i ltered.bin8; 
asm shral .cxdx, #4; 
asm mul .cxdx, #DISF1C1; 
asm shraT cxdx, #4; 
di8.f1ltered.bin8 = '(long *)4.cxdx; 

cx « *(uint *)&input speed.accel; 
JM » 256 - OISFKl; 



/* BIN 8 V 

/* BIN 4 ( cx) •/ 

/* BIN 12 " V 

/* BIN 8 V 

/* save partial result */ 

/* BIN 0 V 
/* 1 BIN 8 - DISFKI V 



input.«pt«d_dcc«l_fUwtd « (UttXdIs.f Ut«r«d.b{na » ty; /* tin 0 •/ 

/** dtttmine state of clutdi •*/ /•^mi thU fs twporary until we get */ 

clutch state over J1959. IM*^/ 

iif (0) 

if (eng!ne_8peed > input^speed) 

clutch_sTip_speed « engine^speed • input.speed; 
else 

clutch_slip^speed « input.speed - engine_speed; 

if (clutch^sl ip^speed > 200) 
clutch^state** OISENGAGED; 
else 

if (<engine_speed > 700} && (low speed latch » FALSE)) 
clutch state « ENGAGED; /* Note: 700 should be idle^lOORPM */ 

#endif 

Below is a known undesirable condition that could be corrected with the J1939 
clutch state information. When input speed is brought below 700 RPM 
while in gear and the clutch is disengaged to acheive gear box neutral this 
algorithm holds the system in the follower mode until the driver bring the 
engine speed above the 700 RPH limit. The 700 RPM limit is needed to prevent 
false ENGAGED indications at idle speeds. ***/ 



/** determine desired percent torque needed for zero torque at flywheel **/ 
#if CO) 

/* This does not work but was not a problem to hard code a value 
because the accessory loading in this vehicle does not change 
much. This algorithm DOES need to work for the product. */ 
if < (accelerator _pedal_position < 2) M 
(clutch_state ENGAGED) && 
(current gear 0) 
(input speed filtered < 1100) && 
(((engTne_control =» OVERRIOE.OISABLED) && 
(low speed latch =« FALSE) il (current^gear » 0)) || 
(output_speed_f iltered < 20))) 
percent torque accessories = eng^percent torque filtered; /* get at idle */ 
#endif 

percent_torque_accessories « 3; /* force value for now */ 

needed_percent_for_zero_f lywheel^trq » percent_torque_acceasorie« ♦ 

nom i na I r i c t i on_pc t_ t rq; 

/** determine overa'll error across the transmission **/ 

overaU_error = ((signed int)(input_speed_f i Itered) - (signed int)(go8)); 



#pragma EJECT 



* Function: coonuiic«t«_uith_driv«Un« 

* OMcriptiont 

* This is the periodic task which controls ths actions of ths engine 

* by defining isode of control and controlling speed and torque output 

* levels depending upon the control function being performed. This task 

* is also intended for control of other drivel ine conponents (not yet 

* named) which nay be available in the future. 

♦*♦****♦**♦******#♦*«***♦****«*♦*«*♦**♦**«********•********«************/ 

void coanunicate with drivel ine(void) 

i ni t i a I i ze^dr i ve I i ne_da t a( ) ; 

X start j>eriodic(); 

irf)ile (1) 

< 

cont ro I _eng i ne_co(npress i on_^br ake( ) ; 

determine_gos(>; /* calculate (G)ear times the (Output (S)haft V 

determi ne_sh i f tabi I i ty_var i abl es( >; 

if ((engine_co(«nunication_active) && 
(R747 type l> BASE) && 
(R747"type DUAL FORCE)) 

€ 

if ((desired_sync_test_(node « TRUE) && (output_speed_f i Itered < 100)) 
cont ro l_eng i ne_sync_te3t_mode( ) ; 

else 

i /* start of normal engine^cooinands switch */ 

switch (engine comnands) 
( 

case ENGINE.PREDIP: 

control ^engine _predip<); 
break ; 

case ENGINE.SYHC: 

cont ro t _eng i ne_sync( ) ; 
break; 

case ENGINE.RECOVERY: 

cont ro l_eng i ne_recovery( ) ; 
break; 

case ENGINE.IDLE: 

control^engineJdleO; 
break; 

case ENGINE.STAST: 

control^en8ine_start( >; 
break; * 

case ENGlNE^FQUQUUt 
default: 

cont rol.englne^f ol I ower ( } ; 

break; 

> 

> /* end of normal engine^conroands switch */ 

switch (eng brake comreand) 

C 

case ENG BRAKE OFF: 

retarder_controi » TORa«,(MMTROl; 
desired_retarder ^t^trq « 0; 
break; 

case ENG BRAKE FULL: 

retarder.control » TORQUC.CXMITROl; 
desired_retarder^t.trq ■ -lOO; 
break; 

case ENG BRAKE IDLE: 



dtftult: 

rttaratr.controt « OvmiOC^oiSABLEO; 
br««k; " 

> 

> 

elst 

engine^status « EMCINE_MOT.PRES€NT; 

/* store old value for ust in "control_engine_fol lower" function */ 
accelerator_pedal_position_old > accelerator_pedal .position; 

X sync^riodicCUS PER LCXJP); 

x^end^per i odi c( ) ; 



* Unpi^lftlMd and conf idvitiai. Not to bo reproducod, 

* dftMilnottd, trmforrtd or used uithout the prior 

* written conoont of Eaten Corporation. 

* Copyright Eaton Corporation, 1994 

* Ail rights reserved. 

* Filename: pr^s_i_s.c96 <R-747) (AutoSplit) 

* Description: 

* The Bio^les contained within this corapitation unit are 

* intended to topltnent functionality of the Process Systea 

* Ir^t Signals task defined in the design docuinention. 

* In general. Analog to digital conversions are started on 

* PortO. The necessary har^are initialization and variable 

* initializtion for inputs on PortO are handled. The switch 

* inputs are captured to avoid conflict with AO conversions 

* and all necessary scaling and error check for these inputs 

* is conducted. 

* Part Nunfeer: <none> 

* $Log: ? 

* Rev 1.3 9 Dec 1994 15:06: tnarkyvech 

* Added "trns_act.h» to the includes so that R747_type could be use to 

* determine if the electric shift knob is a splitter type or a intent to 

* shift type, 

* Rev 1.2 6 Dec 1994 15:06: markyvech 

* Converted for use with R-747 program. (Added clutch & range switches) 

* Also re-scaled ECU-B ignition A2D code to work in ECU-M. 

* Rev 1.1 19 May 1994 11:32:26 markyvech 

* Converted for use with AutoSplit ECU2 

* Rev 1.0 12 Sep 1991 08:04:26 amsallen 

* Initial revision. 



* 

* Header files included. 
* 



#include <exec,h> /* executive information */ 

#include <kr sfr.h> /* ICR special function registers */ 

#inciude <kr3def.h> /* KR definitions V 

#include <c_regs.h> /* KR internal register definitions */ 

#include <w5slib.h> /* world wide software definitions */ 

#include **pr_s_i_s.h* /* process system input signal infonnation */ 

#include "sysgenTh" /* defines the task names and priority */ 
#include "cont sys.h" 
^include »trns"act.h* 



* #defines local to this file. 
* 

/* Start_AO_Conversions */ 

#define ENABLE AO PTS SCAN 0X20 
«define ENABLE A0*1SR 0X20 



«define PERIOD 10U 
#define RICH PERIOD 50U 



/* 10ms */ 
/* 50ms */ 



* Constants and vsris6t«s declared by thU fUs. 



/• Olsitai Inputs on Porti V 

uchar splitter_selact_switch; 
uchar int«nt^to_shif t^switch; 
uchar intent^hoTd; 
uchar intent~hold_ti(ner; 
uchar range_select_switch; 
uchar in_gear_switch; 
uchar split ter_l8unch^state; 
uchar clutch_state; 

/* Analog Inputs on PortO */ 

int ignition_volts; 
int splitter^position; 

#define IGNITION VOLTS CHANNEL RESULT 
#define SPLITTER POS CHANNEL RESULT 



1 

15 



#define CONVERSION TIME Oxef 



#def ine CONVERT 3 8 



/* for state time = 125 nsec: */ 
/* sample time a 3.6250 usee */ 
/* convert time • 20.1875 usee V 
/* scan and convert 8 channels */ 



#define CONVERT_IGNITION_VOLTS 
#def ine UNUSED.CHANNEL T 
#define UNUSED^CHANNEL^S 
HWefine UNUSED~CHANNEl"3 
#define UNUSED^CHANNElIa 
#define UNUSED*CHANNEl"5 
#def ine UNUSED~CHANNEL"6 
#define CONVERT SPLITTER POS 
#define STOP CONVERSION " 
#d€fine START CONVERSIONS 



( norm mode 
<~norm"mooe 
("norm~mooe 
("norm"mooe 
(Inorm^mooe 
(~norm"mooe 

(^NORM^MOOE 
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= convert IGNITION VOLTS 



/* table containing AD^result and AD^Connand values after PTS scan */ 
unsigned int A0_TablecT6) ; 



/* AD SCAN PTS CONTROL BLOCK LOCATION */ 
_adj>tsb_type AD_Con_Btock; 
ipragma rocate(AO_Con_Block=0x01F8) 
#pragma pts(AO_Con_Block =5) 



locate pts control block */ 
set pts vector 5, A/D done */ 



#pra^ EJECT 



Function: InitiadztJnput.Signftlt 

Description: 

This routins initializM ths A/D converter. It sets the A/0 to 
run in PTS sc«n node, 10bit conversion. The PTS control block is 
set up and the Coonwid/result table is initialized. 



void Initialize Input Signals<void) 
< 

/* if we knew when the first speed packet arrived, we could initialize 
with those values, since we don't, be safe and use zero. */ 



AO TableCO) 

AO Tabled] 

A0"TableC2] 

AD"Tablet33 

AD~TableC43 

AD TableCS] 

AD"Table[63 

AO Tablem 

A0*TableC8} 

AO"TableC95 

A0"Table[10] 

A0"TableCl13 

AO"TableC123 

A0"TableC133 

AD3Table[1A3 

A0"Table[153 



AO Con Block. cnt = CONVERT 8; 
A0"Con"8lock.ctrl » ^AO^MOOE LS_0_UPDT; 



AO_Con_Block.s_d = AO^Table; 
AD^Con^Block.reg « (void *)&_ad_result; 

^ad^time = C0NVERSION_TIME; 

*ad*test a NO OFFS; 

j)ts select &= '( PTS ADOONE BIT); 
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UNUSE0_CHAIiNEL,1; 


/* 


■ 


OxOOOOT 


/* 


■ 


UNUSED CHANNEL 2; 


/* 


3 


OxOOOOT 


/♦ 


3 


UNUSED CHANNEL 3; 


/• 


S 


OxOOOOT 


/• 


S 


UNUSED CHANNEL 4; 


/* 
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OxOOOOT 


/* 


3 


UNUSED CHANNEL 5; 


/* 


3 


OxOOOOj 


/* 


3 


UNUSED CHANNEL 6; 


/* 




OxOOOOT 


/* 




CONVERT SPLITTER PCS; 


/* 




0x0000;" 


/* 




STOP CONVERSION; 


/* 


3 


0x0000; 


/* 



place holder for channel 1 
I GN I T IOM_VOLTS.CHANNEL_RESULT 
place holder for channel 2 
UNUSED.1_RESULT 
place holder for channel 3 
UNUSE0.2_RESULT 
place holder for channel 4 
UNUSED.3_RESULT 
place holder for channel 5 
UNUSED_4_RESULT 
place holder for channel 6 
UNUSED_5_RESULT 
Coonnand convert splitter pos 
UNUSE0_6JESULT 
command* to Stop conversions 
SPLITTER POS CHANNEL RESULT 



A/D mode bits 0,1 of PTS^CONTROL 
always set to 3h bit 2 ^ 0 
S/D update at end of cycle 
bit 5 always 0 
Set mode for AO SCAN 



/* Load s_d with AD^Table address 
/* Load reg with A0_Result address 



/* Disable test mode V 
/* Disable AO PTS ♦/ 



#pragma EJECT 



* Fuvtfon: M)JSR 
* 

* Description: 

* This inttnjpt service routine resets the PTSCOUNT, pts_sd and pts^reg 

* for another PTS.Scen A/0 cycle. It also readies a task'to run when 

* a PTS cycle has"coB|)leted. 
• 

fpragma interrupt (AO tSR^S) 

void AO ISR(void> 

{ 

x_start_isr<); 

AD_Con_8lock.cnt = C0NVERT_8; /* Reset pts count for next cycle ♦/ 

A0~Con~8lock.s_d « AO_Table; /* Reset table pointer to start of table 

AD^Con^Block.reg a (void *)A_ad_result; 

x_ready(PROCESS_INPUT^SIGNALS); /* Ready pr_s_i_8 task •/ 

x~end isrO; 



#pr8^ EJECT 



* Function: $tart_AO^Conv«r«ion» 

* Description: 

* This function initializes the input signal processing function 

* if it has not already been done, and then startes the PTS Scan 

* of the AO charMls by sending the appropriate conmand to the 

* ad^coflwand register. 

void Start AD Conversions(void) 
< 

if ((_int mask & ENABLE AO_!SR) »« 0 ) 

InitiaTfze^Input.SignalsO; /* Set up AD table for PTS */ 

jJtS select 1= ENABLE AD PTS SCAN; 
.int'roask |= EMABLE_AO_ISR; 

x_prearin_st iinulus< ) ; 

START_CONVERSIONS; /* Start a conversion, initiate the PTS cycles */ 

X watt stimulusO; /* AO ISR will ready task when PTS is complete */ 
> " " 

#pragma EJECT 



Funct i on: read_sw1 tch^t nputs 

Description: 

Read the state of the digital inputs. 



void read suitch inputsCvoid) 
i 

if <port_1_switches & 0x1) /* P1.0 */ 

in^gear_swi tch = TRUE; 
else* 

in_geBr_switch ■ FALSE; 

if <port_1_switches & 0x2) /* P1,l •/ 

range^3eTect_switch = LOW; 
else 

range_select_^switch » HIGH; 

if (R747 type " IMTENT) 

if (port 1 switches & 0x4) /* P1.2 */ 

i 

intent_to_shift_switch = FALSE; 

if (intent_hold_timer < 25) 

intent_hoid_timer += 1; 
else 

intent hold = FALSE; 

> 

else 
{ 

intent_to_shift_swi tch * TRUE; 
intent hold timer = 0; 

} 



else 
i 

if (port^l^suitches & 0x4) /* PI .2 */ 

spli tter*select_swi tch = HIGH; 
else 

splitter select switch = LOW; 

> 

if ((port_2_switches & 0x30) " (0x10)) 

clutch^state = ENGAGED; 
else 

clutch.state » DISENGAGED; 

#if (0) 

if ( per t_1_sw itches & 0x4) 

splitterjaunch^state » LO.SPLITTEt; 
else * " * 
splitter launch state « HI SPLITTER; 
#endif 

splitter^lauKh.state » LO.SPLITTER; 



^pragma EJECT 



* FtfKtlon: proem input signals 

* Owcpiptlon: 

* Thi« it the periodic tasic which starts the analog conversions on PortO. 

void process input signals(void) 
i 

intent_hold = FALSE; /• initialize intent_hold */ 

x_s t ar t_per i od i c ( ) ; 

while (1) 

< 

read_sw i t ch_ i nput s ( ) ; 

S t ar t ^AD_C onver s i ons ( ) ; 

/* Clean up and scale AO values */ 

ignition^voUs = scale_system_ad_inputs( IGNITION_VOlTAGE); 
spl itterjjosi tion a scale_syste«^ad_inputs(SPt.ITTER_POSITI0M); 

x_sync_per 1 od i c ( PER 1 00* 1 000 ) ; 
/* X syncj>eriodic(RKM PERIX*1000); */ 
> ' 

X end_periodic(); 
#pragma EJECT 



Function: scatt.systea^ad.inputs 

Description: 

This function removes the channel, status and reserved bits from 
the raw AO values, and perfoms all necessary scaling and error 
checking for the analog inputs on PortO. 

int scale system ad inputsCchar Channel) 
i 

int Scaled Value » O; 
uint voltsj)er_bit; /* BIN 16 •/ 
uint units j>er bit; /* BIN 16 V 
/* #define TU€LVE VOLT FULL SCALE 22.46 */ /* ECU 8 volts */ 

#define TWELVE VOLT FULL SCALE 34,51 /* ECU 2 volts */ 

#define TUEMTY'foUR VOLT FULL SCALE 40.49 /♦ volts */ 
#define DISTANCE FULL SCALE 100 /* V 



volts j>er bit = (uintXCTUELVE VOLT FUL L_SCALE*65 536/1 023)+0.5); 
units_per_bit ^ (uint)<(DISTANCE_FULL_SCALE*65536/1023)+0.5); 

switch (Channel) 
i 

case 0: /* IGNITION VOLTAGE V 

_cx « ADJable(IGNITI0N_V0LTS_CHANNEL_RESULT3 » 6; 

asm mulu" cxdx, voltsjser bitj /* volts, BIN 16 <_dx, BIN 0) */ 

Scaled^VaTue = *(int *)&_dx; 

break; 

case 1: /* UNUSED */ /* to be completed when a product requires it */ 
Scaled_Vatue = <0); 
break; 

case 2: /* UNUSED */ /* to be completed when a product requires it */ 
Scaled_Value = (0); 
break; 

case 3: /* UNUSED V /* to be conpleted when a product requires it V 
Scaled_Value = (0); 
break; 

case 4: /* UNUSED */ /* to be completed when a prodict requires it */ 
Scaled.Value > (0); 
break; 

case 5: /* UNUSED */ /* to be completed when a product requires it */ 
Scaled_Value * (0); 
break; 

case 6: /* UNUSED */ /* to be completed when a product requires it */ 
Scaled.Value » (0); 
break;" 

case 7: /* SPLITTER POSITIOH */ 

_cx a AO_TableCmiTTEIl.POS^CHAim«L.RESULTl » 6; 

asm mulu cxdx, unlts^r bit; /* distance, BIN 16 ( dx, BIN 0) V 

Scaled^VaTue « *C1«t 

break; 

default: 
break; 

> 

return (Scaled^Value); 



* UnpubUshtd and conf IdantUl. Mot to bt reproduced. 

* dlsMiDfrated. transferred or used without the prior 

* written consent of Eaton Corporation. 
* 

* Copyright Eaton Corporation, 1991-94. 

* All rights reserved. 



* 

* Filename: secLshft.c96 {R-747) (AutoSplit) 
• 

* Description: 

* The functions in this file will perform the required systea 

* level operations for implementing Sequence Shift. 
* 

* Part Nunber: <none> 
• 

* Rev 1.2 12 Dec 1994 09:15 markyvech 

* In function »*sequence_shift()" added code for the intent_hold. 

* Rev 1.1 09 Dec 1994 08:07 markyvech 

* In function "sequence^shiftO" added code for the intent to shift 

* feature. This will allow shif t_ini tiate, (predip mode), to be called. . 

* Also added code to allow for the cancellation of intent to shift if 

* conditions allow, (call confirm shift). 
* 

* Rev 1.0 12 May 1994 16:26:00 markyvech 

* Initial version 
* 



* 

* Header files included. 



#include 
#include 
# include 
#include 
finclude 
#include 
#include 
#include 
#include 
#include 
#include 
#include 



<exec.h> 

<c_regs.h> 

<wwslib.h> 

"cont sys.h" 

"conjT939.h" 

"con_o_s.h" 

"drrcmds.h" 

"set gear.h" 

"shf"tbl.h" 

"trn^tbl.h" 

"trns act.h" 

»pr_sj_s,h" 



/* 
/* 
/* 
/* 
/* 
/* 
/♦ 



executive information */ 

ICR internal registers */ 

World Wide Software Library */ 

control system information */ 

Defines interface to engine coonuni cat ions info 

control output signal information */ 

drivel ine commands information */ 



/* Contains information relative to engine 

/* transmission table information V 

/• transmission information */ 

/* process system input signals information V 



* #defines local to this file. 
* 



* 

* publics. 



cnsigned char forced j>red1p_tia)er; 
unsigned char init_dest_gear^timer; 
signed char ini tTat_destination_ge8r; 



* Constants and variables declared by this file. 
* 

static uchar coast^mode; /* allows veh-icle to coast in low gears */ 

#daf ine FORCED PREDIP TINE 150 /* 300 MSEC at 5 counts per loop V 

«define IM SYMC MODE TIKE LIMIT 200 /• 2 SEC */ 



* FtfKtlons Initial fz«.t«qu«nc*_shift 

* " 

* Description: 

* ThU function initial fztt thosa nodule variables that must be set to a 

* know state on power up or reset. 
• 

void initialize sequence shift(void) 
< 

shift.type « UPSHIFT; 
shift_in_process = FALSE; 
force5_predip^timer = 0; 



ipragma EJECT 



* Function: shiftjnitiatr 

* Description: 

* This finction begins tht shift sequence by setting up the 

* transmission to pull to Neutral, connands the electronic engine 

* controller to go to zero torque and prepares the clutch to disengage 

* if required. 
• 

static void shift initiate<void) 



/* (do not request engine fueling with engine brake on) */ 
enQ_brake_coninand * ENG_BRAKE_OFF; /* eng brake: zero torque */ 

if <(lpf_output_speed < shf_tbl.min_output_spd) || 

(clutch^state == DISENGAGED) || 

((coast_mode) && (shift^type !» UPSHIFT) && /* Prevents engine control 
((destination^gear < 3)"|| /* in low gear(s) downshifts, 

((destination"gear < 4) 4& (acceleratorj>edal_posi tion <» 5))))) 

engine coamands = ENGINE FOLLOWER; 

else 
< 

engine_coninands = ENGINE_PREDIP; /* engine: bring torque to zero •/ 

coast mode = FALSE; 

> 

> 

#pragma EJECT 



* function: synchronlie^^gear 

* Description: 

* This fOKtion assists th# sychronizing of the transmission by 

* uti tiling SA£ J1939 functions to control an electronic engine. 
* 

static void synchronize gear<void) 
C 

/* turn on engine brakes <J1939) if engine bralce assisted shift is requested */ 

if (eng brake assist) 

eng^brake.coomand « ENG_BRAICE_FULL; 
else 

eng_brake_coranand » ENC_BRAKE_OFF; 
if ((lpf_output_speed < shf_tbl .min_output_spd) || 
(clutch.state » DISENGAGED) || 

((coast^mode) && (shift^type 1= UPSHIFT) && /* Prevents engine control V 
((destination^gcar < 3)"|| /* in low gear(s) downshifts. */ 

((destination"gear < 4) && (accelerator _pedal jx>sition <= 5))))) 

C 

engine conmands = ENGINE FOLLOWER; 

> 

else 
{ 

engine_co(iinands = ENGINE^SYNC; 
coast iiiode = FALSE; 

> 



if ((engine status ENGINE SYNC MODE) && 
(enginelcocnmands ENGINE_SYNC)) 
init_dest_gear_timer » 0 ; 

if (init dest gear timer < 8) 

initial_destination_gear = destination_gear_selected; 
init dest gear timer**; 
> " " ' 



/* Save the initial gear •/ 
/* to check for a new one */ 
/* as the shift progresses. */ 



else 

if ((engine_status « ENGINE_SYNC_MO0E) && /* If the gear changes, • 

(initial destination gear != destination gear^selected)) /* force the predip mode * 
i * " ~ /* to allow the splitter * 

forced j)redip_timer = FORCED_PRE0IP_TIME; /* to move. * 

forced_predip = TRUE; 

> 



fpragma EJECT 



* Function: conf irw.shift 
• 

* Description: 

* This function finishes the shift; shift inj?rocess is set FALSE. 

static void confirm shift(void) 
i 

engine^commands = EMGINE^RECOVERY; /* engine: finish torque return 

eng_brake_co(nnand = ENG_BRAK£_OFF; /* eng brake: zero torque */ 

shift_in_process = FALSE; 
coast'mode « TRUE; 



#pragina EJECT 



Func t i on: s«quence_9h i f t 

Description: 

This function calls the appropriate procedures to perform the 
operations of Sequence.Shif t depending on the current state of 
the shift process. 



void sequence shift(void} 
i 

if (destination gear < last known gear) /* determine shift type */ 
< 

if (pet demand at cur sp > 5) 

shift^type »"POWER_OOUN_SHIFT; 
else 

shift type - COAST DOWN SHIFT; 

> 

else 

shift_type = UPSHIFT; 

if ((forced j5redip_timer >» 4) && /* Time out a forced return to the predip node */ 
(g_ptr =» 0)) " /* if the destination gear selected changes */ 

forcedj5redip_tiiner 4; /* during the sync laode. */ 

if (forced _predip_timer > 0) 
f orced_pred i p_t i mer- - ; 

if (destination gear == NULL GEAR) /* System has reset: do not start a shift */ 
i 

engine commands = ENGINE^FOLLOWER; 
eng brake command = ENG BRAKE IDLE; 
> " " 

else 

if ((transmissi on-position == OLIT_OF_GEAR) && 
(forced_predip timer == 0) && 
((engine status"== ENGINE SYNC_M(30E) j| 
(engine"status == ENGINE"pREDIP MODE))) /* forces shift initiateO */ ; 

{ " " " 

synchronize gearO; _ 



else 

if ((((engine status ENGINE SYNC_M(X)E) || 

(engine^status == ENGINEIrECOVERY_MOOE)) && 
(forcedj3redip_timer 0) && 
(destination^gear == current^gear) && 
(transmissionjsosition IM^GEAR)) || 

((shift_in_process — TRUE) && /* cancel intent to shift if */ 

(intent to shift switch » FALSE) &A /* conditions allow it. */ 
(shiftjnlt^tvp*""«» MANUAL) U 
(autoontic.sip Q) 44 
(transmisticn^^position IV (aEAR) U 
(engine status » ENGIXC PRfiOlP MODE))) 
i ~ 
conf irm_shif tOr 



else 

if (((destination gear !» current_gear) && /* auto splitter */ 
(low_speed_latch «« FALSE) W~ 
( automat ic_sip != 0) 
(transmission_position IM_GEAR)) || 

((intent_to_shift_switch ■« TRUE) && /* Allows for intent_to_shif t 

(desired_gear !="destination_gear_selected) && /* manual shift. 
( intent _hold FALSE) &4 " " 
(automatic sip 0) && 
(shift init type « MANUAL) && 
(low^speedjatch FALSE) U 
(transmissTon_position «« IN_6EAR)) || 



(forced_predip.titner > 0) || 



/* gear changed during shift •/ 



((transaission^posltion out Of GCAA) U /* aanual thfft V 



( 

shift initiateO; 

} 



Ur^ublifthtd and conf fdtntial. Mot to be reproduced, 
dl8S«o{nat«d« trmftrred or used without the prior 
written consent of Eaton Corporation. 

Copyright Eaton Corporation, 1993-94. 
All rights reserved. 



Filename: sel_gear.c96 



(R-747) (AutoSplit) 



Description: 

This module is the periodic task "select^gear". It assigns values 
to destination_gear_selected as a function of selected_(i»de, input 
and output shaft speeds. 

* Shift parameters are in the data structure shf_tbl. 

* Part Number: <none> 
* 

* Rev 1.1 12 Dec 1994 08:05 markyvech 

* In function »detennine_inanual_shiftjDts()", changed auto_up_rpni from 

* 1350 RPH to 1425 RPM because the transmission has been changed to a "B" 

* ratio and skip upshifts need to be avoided. 
* 

* Rev 1.0 14 Sep 1994 14:02:00 markyvech 

* Initial revision. 
* 



* Header files included. 



#include <exec.h> 
#include <c_regs.h> 
#include <uwslib.h> 
#include "cont sys.h" 
#include »conjT939.h" n 
#include "drl^cmds.h" n 
finclude "seTgear.h" 
#include "shf"tbl.h» n 
#include "trn'tbl.h" n 
#include "calc_spd,h» 
#include "trns"act,h» 
#pragma noreentrant 



executive information */ 
c registers */ 

contains conmon global defines */ 
control system V 

defines interface to jl939 control module */ 

drivel ine commands information */ 

select gear */ 

shift table definition */ 

(system) transmission table definition */ 



* #defines local to this file. 
* 

#def ine US_PER>OOP 40000U 

#def ine IMITIAL.START.GEA* t 

#define SHIFT INHIBIT OECEL LIMIT *150 



* Constants and variables declared by this file. 



/* public V 

char destination^gear^selected; 

char destination_gear; 

char f I ash^des i red_a 1 1 owed; 

char desired^gear; 

char des i r ed_gear^dn; 

char des i r ed_gear_up; 

uchar coasting_latch; 

uchar shi f t^i ni t^type; 

ui nt I pf .out put_speed; 



fnt dos ^tdlct«d; /♦ SIM 0 V 

int dot j)rdtd,li»_noJak»; /♦ 8tl 0 ♦/ 



/• local V 

/* filter weights for th« "mda" output apeed filter */ 
static register uchar w1; 
static register uchar w2; 
static register uchar w3; 
static register uchar w4; 

/* shift table (define and extern in shf^tbl.h) V 
struct shf_tbl_t shf^tbl; 



/* default shift table values */ 
const struct shf tbl t ini shf tbl » 
i 



1200, 


/* 


aut_dwn_rpro */ 




1000, 


/* 


aut*iBin]^dwn_rpoi */ 




1700, 


/* 


aut_up_rpoi */ 




0, 


/* 


best_,gr_of fset */ 




50, 


/* 


dwn_^offset_rpfli */ 




100, 


/* 


dwn*reset_rpai */ 




400, 


/* 


dwn"timer"off8et.rpm */ 




40, 


/* 


hysTeresis^rpm *7 




1850, 


/* 


man_dwn_sync_rpra */ 




700, 


/* 


^'^-^^-.sync^rpm */ 




1900, 


/* 


rated^rpm *7 




150, 


/* 


up_of 7 set_rpm */ 




125, 


/ 


up_reset_rpm */ 




200, 


/* 


up"timer2offset_rpro */ 




0, 


/* 


dwn_acceT */ 




8, 


/* 


up_accel */ 




3000, 


/* 


offset^time */ 




(uintXO. 25*256), 


/* 


aut_up_pct */ 




10, 


/* 


min_output_spd */ 




1, 


/* 


max^start^gear */ 




0, 


/* 


padbytel */ 




196, 


/* 


k1 ability, mi n- ft/rev- sec. 


BIN 12 */ 


431, 


/* 


axTe.ratio^cal, BIN 7 V 




383, 


/* 


gcw ici, rev/sec-min-ft, BIN 


0 */ 


2437, 


/* 


gcw3it2, rev/sec*2, BIN 7 */ 




1325, 


/* 


cal6_start^int, rpm, BIN £ 


) */ 


107, 


/* 


Ic6 ability, min- lb- ft- sec/rev, BIN 8 V 


1500, 


/* 


auto_up_lo_base, rpm, BIN 0 


*/ 


1100, 


/* 


auto~dn3lo"base, rpm, BIN 0 


*/ 


100, 


/* 


auto^rtd_offset, rpm, BIN 0 


*/ 


1000, 


/* 


lowest_engage_rpm, BIN 0 V 




0, 


/* 


padwordi */ 




0 


/* 


padword2 */ 





>; 



/* local initialized at start of task by select_gear */ 

/* shift points with ant 1* hunt offsets; referenced by auto_downshift and 

auto_upshift; set by g^t^autoiaatic^gMH* and select_gear~*/ 
uint uf»hift_point; " " 

uint downshif t_point; 

/* lower Unit for gear selections */ 
char lowest^forward; 

/* indicate direction of a get_automatic^gear shift; referenced by 

get^inanual^gear; cleared by~select_gear when shift complete •/ 
char automat ic.sip; 

/* used in the determination of shift^polnts based on throttle position * 
static uint auto_up_rpn; 
static uint auto'dn^rpra; 
static uint auto^up^offset^rpra; 
static uint auto^dn^of fset^rpm; 

/* delay counter for ant i- hunt •/ 
static uchar ant i hunt. count er; 

/* gross confined weight calculations V 



«d»f tm ZERO^SPEiO TUC.LUttT 4509 
M»f irw VALID OLD MTA TIMi lOQ 
idtf frw MAX VCNICtE UiTcKT 100000 
Mtf 1n« 0OS*OFFSCT TnIT 4a 
idef In* ENG'oECEL LOU LIMIT <350 
#dtf{rtt E>M5"0£C£L"lPF" 224 



/* 3 min a 0.040 ptrlod V 
/« 4 s«c 8 0.040 period V 
/• 100,000 lbs V 

/* rpw/s */ 

/• exp<-2pi(0.53H2)(0.040s)) ^ 0.875 (BIN 8) V 



#if (0) 
static ulong 
static long 
static uint 
static ulong 
static uchar 
static uchar 
static uchar 
static uint 
static uchar 
static uchar 
static uint 
static int 
static int 
static uint 
static uchar 
static uint 
static int 
static int 
static int 
static uchar 



gro8S_co(rbi ned^wet ^ t ; 
9Cw_local; 
gcw^local^counter; 
gcw*local"total; 
va I Td_o I d~da t a_cotr t er ; 
mi ss«d_sh i f t_off set^arflUj- 
gcw^caTculatTon^al lowed; 
zero_speed_count er ; 
gcw_first_shift; 
dos"filtef_latch; 
gcw3cal;.new; 
dos'f iltered^old; 
dos"offset; 
sync^de 1 1 a_t i raer ; 
dis_?ilter_latch; 
i nput_spd_f i r 8 t_po i n t ; 
eng_decel2latest; 
eng^decel^rate; 
eng2decel"rate^wth_j ake; 
used_€ng_brk; 



/* shiftability calculations V 

#defin€ TORQ ACC LPF 230 

#def ine IC7 ABILITY 249 

#define FIXED LIMIT -30 

#define FIXED^LIMIT 1 -36 

#define SHF_BLY_HOLD,C0UNT 3 

static uchar shi ftabi I i typhoid; 
static uchar shi ftabi lity^hold^^IIi- 
static uchar shf^bly^hold^cntrj 
static int dosjjredicted^faw; 
static long dos J3redicted_bin8; 
static long dos _predictedj)artial_1; 
static long dosjDredicted_partial_2; 
static int dosj>rdtd_l ira^wth^jake; 
static int vehicle_accel_bs; 
static int vehicle"accel~as; 
static int engine^torquej 
static int torque*at_uheels; 
static int torq_to_accel_eng; 
static uint gcw^cal; 
static uint TRAij$^STEP_SI2E_CAL; 
static uchar torque accessories; 
#endif 



/* lb-sec"2, BIN 0 V 



/* 0,9000 BIN 8 V 
/* 0.9730 BIN 8 */ 



/* 120 (ns a 0.040 period */ 



/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 



BIN 0 
BIN 8 
BIN 8 
BIN 
BIN 
BIN 
BIN 
BIN 
BIN 
BIN 



*/ 
*/ 
*/ 
*/ 
•/ 
•/ 
*/ 
*/ 
*/ 
*/ 



lb-sec"2, BIN 0 V 

BIN 8 V 
Ib-ft, BIN 0 */ 



#pra9aa EJECT 



4# AttAftAAt ♦ ft ASM A AC AftftftA Aft#ftftftft 

* Function: aid8.output_f i Ittr 

* ~ ~ 

* Description: 

* This is a one poie LPF with • variable coefficient. The magnitude 

* of the coefficient is directly related to the acceleration content 

* of the speed sample and the frequency. 
• 

static void mda output filter(void} 
i 

#define ICI 8 
#define K2 24 
#def ine IC3 48 
#define K4 160 

static register uint os_delta_speed; 
static register uchar weight; 

if (Ipf^output^speed > output_speed) 

os_delta_speed = I pf _output_speed - output^speed; 
else ~ 

os_delta_speed » output_speed - lpf_output_speed; 

if (OS delta speed <= Kl) /* delta <= 200 rpm/s */ 

C 

if (u1 > 1) --w1; 
if (w2 < 5) ++w2; 
if (u3 < 6) ++w3; 
if (u4 < 7) ++w4; 
weight = w1 ; 

> 

else if (OS delta speed <= K2) /* 200 rpm/s < delta <= 600 rpm/s V 
C 

if (w1 < 4) ++wl; 
if (w2 > 2) "w2; 
if (w3 < 6) ♦+w3; 
if (w4 < 7) ♦♦w4; 
weight = w2; 

> 

else if (OS delta speed <= K3) /* 600 rpm/s < delta 1200 rpm/s V 
C " " 

if (wl < 4)>+w1; 

if (w2 < 5) >+w2; 

if (w3 > 3) "w3; 

if (w4 < 7) ♦+w4; 

weight = w3; 

> 

else if (OS delta speed <» )(4) /* 1200 rpm/s < delta <= 4000 rpm/s */ 
C " " 

if (wl < 4) ♦+w1; 

if (w2 < 5) ++w2; 

if (w3 < 6) >*w3; 

if (u4 > 3) --w4; 

weight ■ w4; 

> 

else /* 4000 rpm/s < delta */ 

< 

if (wl < 4> ♦^l; 
if (w2 < 5) 
if <w3 < 6) ♦♦wS; 
if (w4 < 7) ♦+w4; 
weight = 7; 

> 

lpf^output_speed » lpf_output_speed ♦ 

<output~speed » weight) -"(Ipf output.speed » weight); 



fpragma EJECT 



* Finction: nett_input_spe«d 

* Description: 

* A utility function that returns the input shaft speed expected if 

* "gear** was engaged with the present output shaft speed. 
* 



static uint new input speed(char gear) 
€ 

/* new_input_speed = ipf_output_speed * gear_ratio */ 

.ax » trn_tbT.gear_ratioTgear ♦ GR_0FS3; ~ /* SIM 8 */ 

asm mulu "axbx, Ipf output speed; " /* BIN 0*8=8 < axbx) ♦/ 

asa shrl ^axbx, #8;" " /* BIN 8»»0 (^ax) V 

return ax; 

> 



#pragma EJECT 



* Function: auto_upshHt 

* " 

* Description: 

* This boolean function returns true when automatic upshift 

* conditions have been met. 
* 

static int auto upshif t(void) 
i 

if ((gos > upshift jxint) M (output speed filtered > 120)) 
C 

if (engine comnunication active) 
< " 

/* if ((!shiftability_hold) U (Ishiftability.holdJD) */ 
return 1; 

> 

> 

return 0; 



^pragma EJECT 



* 

* Function: tuto^downshltt 

* "* 

* Description: 

* This boolean fmctfon returns true when autocnatic downshift 

* conditions have been met. 
* 

static int auto downshift (void) 
< 

if (gos < downshift_point) 
C 

return 1; 

> 

return 0; 
^pragma EJECT 



* Description; 

* This function is us«d to deternirw 

* NAMUAL or AUTO. 



if the iopending shift type is 



static char determine autosplit type<char passed new gear, char passed initial gear) 
i 

register char new_gr = passed_new_gear; 
register char init^gr » passed_initial_gear; 



if ((shift in process » FALSE) || 



if ((new^gr « 
(new*gr »» 
(new^gr =« 
(new^gr =* 
(new^gr =■ 
(new^gr 
(new^gr == 
(new^gr =» 
(new_gr == 
Cnew^gr 



1 && init_gr 
3 &i init"gr 
5 ft& init"gr 



7 U 
9 && 

10 &i 

8 && 

6 U 
4 && 
2 && 



init_gr 
init_gr 
init~gr 
init_gr 
init"gr 
ini t_gr 
ini t_gr 



shift_init_type = AUTO; 
else 

shift_init.type = MANUAL; 



(engine.status " ENGINE.RECOVERY^MOOE)) 



2) 
4) 
6) 
8) 
10) 
9) 
7) 
5) 
3) 
D) 



/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 



dn 
dn 
dn 
dn 
dn 
up 
up 
up 
up 
up 



*/ 
*/ 
*/ 
*/ 
*/ 
*/ 
*/ 
*/ 
*/ 
*/ 



#pragma EJECT 



* Function: gct_autoroatic_g«ar 

* Description: 

* This function detennines the appropriate gear for both automatic 

* splitter shifts and manual lever shifts. 

static char get automatic gear<char initial gear, char manual request) 
register char new_gear = ini tial^gear^- 
if (automatic sip != -1) 
< 

/* initiate or continue an upshift: search up from lowest_foPward 

(fastest input speed) for the first available gear that will provida input 
speed below a value (approx upshift rpm, minus an offset for gears that will 
result in a net downshift) */ 

for (new_gear = lowest^forward; 

(new_Tnput_speed(new_,gear) > (upshift jx)int - 
(new_gear < initial^gear ? 

(shf^tbl .up_of fset_rpm + auto_dn_of fset_rpm) : shf^tbl .best_gr_of fset))) 
&& (new_gear < trn_tbl .highest_forwa^d); 
++new_gea^) 



if ((initial_gear == 3) && ((new_gear ==2) || (new_gear == 1))) 

new_gear - ini tial^gear^- 
desired^gear = new_gear; 
desired_gear_^up = new_gear; 

de t e rm i ne^auTos p I i t _ t ype ( new_g ea r , initial _gea r ) ; 

/* if lever shift and still in gear, keep initial_gear */ 

if (((shift_init_type == MANUAL) && (transmissi on-position == IN_GEAR)) || 

((automatic_sip == 0) && (new_gear <= initial_gear)) || 

((dgos < SH1FT_INHIBIT_0ECEL_L1MIT) && 
((transmission_posi tion IN^GEAR) || 

((transmission_position == OUT_OF_GEAR) && (shift_init_type " AUTO))))) 
new^gear = ini tial_gear; 
else 
C 

/* indicate gear change and adjust downshif tj5oint V 

automat ic_sip = +1; 

auto_up_of fset^rpm = 0; 

if (shift^init^type == AUTO) 

auto_dn_of fset^rpm = shf_tbl .dwn_timer_of fset_rpra; 
else 

auto dn offset rpm = 0; 

> 

> 



if ((automatic sip l« 1) && (initial gear > lowest forward)) 
{ " 

/* initiate or continue an downshift: search down from 

highest.foruard (slowest input speed) for the first available gear that will 
provide'input spaed above a value (approx downshift rpm, plus an off sat for 
gears that will result in a net upshift) V 
for (new_gear « trn_tbl .highest_forward; 

(new_input_speed(new^gear) <"(downshift_point ♦ 

(new^gear > initial^gear 7 shf_tbl .dwn_of fset^rpm : shf^tbl.best^gr^of fset))) 
&& (new^gear > lowest_?orward); 
--new_gear) 



if ((initial_gear 3) && ((new^gear « 2) 1 1. (new_gear =*» 1))) 
new_gear » initial^gear; 

de8ired^gear_dn » new^gear; 

if (desired_gear^dn < initial^gear) /* Must be a down shift or clsa it nay •/ 
de8ired_gear """new^gear; " /* wrongly cancel the desired^up pick. */ 



/* If l«v«r shift md stUI in gw^ ktcp initfal gMr V 

if (((thiftjnit.type »« KAJWAL) U (tr«naii$«ion>)sition « IN.G£A«» || 

((•utoiR8tic_sip «« 0) tt (new^gear >« ini tial_gear)> || 

«dgo« < SHIFTJNHIBIT_OeCEL_LIMIT) && 
((transmissfoniosition " IM_GEAR) || 

((transmission jxaition «« OUT^OF_GEAR> && (shift_ini retype == AUTO))))) 
ne«_gear a initial^gear; 
else ~ 
< 

/* indicate automatic gear change and adjust upshift _point */ 

automat ic_sip = -1; 

auto^dn^of fset_rpra » 0; 

if (shift^init^type " AUTO) 

auto_up*offset_rpm « shf_tbl -up^^timer^of fset_rpa»; 
else 

auto up offset rpm » 0; 

> 

> 

return new gear; 

> 

#pra9na EJECT 



* Function: dtttnafnt^desti nation 

* Description: 

* This function uses "coastinfl^lstch** to determine if a coasting or 

* skip shift is being attetrpted. ^en sensed, the latch is used in 

* the determine_base^ts function to affect the base shift points. 

void determine destination(void> 
i 

/* if coasting in neutral - modify shift points */ 

if (coasting latch » FALSE) 
< 

if ((last known gear - destination gear selected) > 1) /* multi downshift 
C " " 

if ((de3tination_gear_selected == 7) 

(destination^gear^selected « 5) 

<destination*gear^selected ==3) 

(destination gear selected D) 

i 

des t i na t i on_gear_se I ec t €0*++ ; 
coasting latch ="truE; 

} 

> 

else 

i 

if ((destination gear selected - last known gear) > 1) /* multi upshift 
i 

if ((destination_gear_selected « 10) 
(destination_gear*selected 8) 
Cdestination_gear_selected " 6) 
(destination'gear selected » 4)) 

C 

des t i na t i on_gear_se I ec t ed- - ; 
coasting latch 3 TRUE; 

) 

> 

> 

> 

else 

if (shift_inj5rocess == FALSE) 
coasting^latch « FALSE; 



#pragma EJECT 



• Function: detemine^manual^shlft jt« 
* 

• Description: 

static void deterrain«_inanual_shift_pts<void) 



if (coasting latch " FALSE) 
i 

if (<last_known_gear == 1) 

< last_known_gear »= 3) 

<last_kno«n_gear =3 5) 

(last"known"gear 7) 

(last^known^geap — 9)) 
auto_dn'rpro a"l325; /* manual downshifts */ 

else 

auto up rpm = 1425; /* manual upshifts */ 



> 

#pragma f:JECT 



* Function: dtttntint.bw^auto^ahift _^t« 

* Description: 

* This fcnction detsrmlnts the base up and down shift points based on 

* the position of the throttle. These base points will be used in the 

* calculstion of the upshiftjjoint and the downshif tjwint. 

* The anti-hunting calculations have been moved to this function since 

* these calculations are now throttle dependent. 

static void determine base auto shift _pts(void) 
C 

if <pct demand at cur sp > 0) 

/* auto up rpm 3 shf tbl.auto up lo base * 

((shf.tbl.aut.up.rpn - shf2tbT.auto_up_lo_base) • Xthrottle) * 

_cx e shf_tbl.aut_up_rpm - shf^tbl .auto_up_lo_base; 
3bx « pct"demand_at_cur_sp; 
asm mulu _cxdx, _bx; 
asm divu _cxdx, 5l00; 

auto^up_rpm = shf_tbl .auto_up_lo_base * _cx; 

/* check for RTD requirement */ 
if (pct_demand_at_cur_sp > 90) 

autoj|up_rpm +=*shf_tbl ,auto_rtd_of f set; 

/* auto^dn^rpm = shf_tbl .auto_dn_lo_base + 

((shf_tbl.aut_dwn_rpm -"shf_tbl .auto_dn_lo_base) * Xthrottle) 

_cx » shf_tbl.aut_dwn_rpm - shf^tbl -auto_dn_lo_base; 
^bx s pct"demand_at_cur_sp; 
asm mulu _cxdx, _bx; 
asm divu "cxdx, #100; 

auto dn rpm » shf tbl.auto dn lo base * cx; 
^ - - 

else 
< 

auto_up_rpm = shf^tbl .auto_up_lo_base; 
auto~dn*rpm a "shf^tbl .auto_dn_lo_base; 



determine_manual_shi f t j3ts( ); 

if (shift injsrocess) 
C 

/* reset antihunt_counter */ 
antihunt_counter = 0; 

/* allow the knob display to flashed any new desired gear */ 

flash desired allowed > TRU€; 
> " ' 

else 
< 

/* reset shift in process flags end update antihunt_counter */ 

automat ic_sip « 

if (antihunt counter < 255) 

C 

++antihunt counter; 

> 

/* look for upshift anti-hunt reset conditions */ 

if ((antihunt counter * (US PER LOOP/1000)) shf tbl.offset.time) 

/* check for last shift ' upshift effects */ 

if (auto_dn_offset_rpra == shf_tbl .dwn_timer_of fset^rpro) 

auto_dn_offset_rpm = shf_tbl .dfcm^of fset^rpm; 
else if"((auto_dn3offset_rpm a= shf^tbl .dwn_of fset^rpra) && 

(input_8peed_fTltered*> auto_dn_rpm ♦ shf_tbl .dwn^reset^rpm)) 

auto_dn_offset_rpra = 0; 

/* check for last shift » downshift effects */ 
if (auto_up.offset_rpm 3» sh#_tbl.up_timer_of fset^rpm) 
auto_up_offset_rpai « shf^tbl .up.offset^rpra; 



•ls« \f ((tuto_t4>^offMt.rp» u shf_tbC*up.offs«t_rpi) 

auto^up^offMt^rpn ■ 0; 
/* ailou the knob display to flashed tha desired gear V 

if (((desired.gear > destination_gear_selected} && (gos < (upshift ^int ^ 25})) || 
((desired'gear < destfnation'gear'selected) && (gos > (downshift _point * 25)))) 
flash_desired,aUowed » FALSE;" 
else 

flash desired^alloued » TRUE; 



/* set the shift points based on throttle and determined offsets V 
upshif t_point = auto_up_rpni ♦ auto_up^off set^rpm; 
dowTshif t_point « auto_dn_rpm • auto_dn_of fset_rpm; 

/* check that the calculated shift point is reasonable */ 
if (upshiftjjoint > shf_tbl .(nan_dwn_sync_rpm) 
t^hift_point = shf_tbl.man_dwn_sync_,rpm; 

if (downshi f t^int < shf^tbl .man_up^sync_rpm) 
downshi f t_point = shf_tbl .man_^up^sync_rpni; 



^pragma EJECT 



Function: 3eltct.9««r 
Oetcriptfon: 

Thit it th« root function for th« periodic task SELECT^GEAR- Each 
loop begfnt by chocking tho nonual v4>/down buttons. Then, based on 
seiecttd^mode and output shaft speed, a 'get_. . ._9ear* function is 
called to t^date destination^gear^selected. 



void select gear(void) 
C 

char inanual_request; /* current manual request (+/- 1) */ 

static uchar enable_gcw_calc; /* diagnostic - delete later I!*/ 

enable_gcw_calc ^ FALSE; /* diagnostic - delete later II*/ 

shf_tbl 3 ini^shf^tbl; /* initialize the shift table V 

destination_gear_selected = 1; 
desired_gear = 1; 

/* initialize file scope variables */ 

Ml s 3; 
u2 - 4; 
w3 a 5; 
u4 s 6; 

lpf_output_speed = output_speed; 

upshiftjxjint = shf_tbl .aut_up_^pm; 
downsh i f t_point = shf_tbl.aut_dwn_rpm; 
auto_up_offset_rpro = shf_tbl .up^tTroer^of f set^rpm; 
auto"dn offset rpm « shf tbl.dwn timer offset rpm; 
lowest J orward"= INITIAlIsTART_GEAR; 
automat ic_sip = 0; 
antihint^counter » 255U; 
coasting latch ' FALSE; 
flash^desired.allowed « TRUE; 

#if <0) /* shiftability variables */ 

zero speed counter = ZERO SPEED TIME LIMIT ♦ 5; /* force init of gcw variables */ 
eng_decel,rate = -400; 7* RPm7sec */ 

TRANS_STEP_SIZE_CAL = 346; /* 1.352 BIN 8 (was constant) */ 

torque accessories = 100; /* accessory load with air condition off in coach */ 

gcw caT = 2400; /* (GCU x 1.68)/32.17 BIN 0 (was constant) */ 

gcw"cal.new = 2400; /* (GCW x 1.68)/32.17 BIN 0 (was constant) */ 

gcw" I oca I = 45000; 

gcw_local_counter » 50; 

gcw^local^total ■ 2250000; 

gross^cotnbined^weight = 45000; 

#endif /* shiftability variables */ 

X start jseriodicO; 

while (1) 

< 

mda_output_filterC>; /• update our filtered output speed •/ 

#if (0) /♦ shiftability V 

if (enable gcw calc) /* diagnostic aid IIV 
< 

det ermi ne_gr oss_cofflbi ned.we i gh t ( ) ; 
determi ne^sh i f t abi I i ty( )7 
determine"shiftability IK); 
> ' 7* shiftability */ 

fendif 

eaanual_request « 0; 

detenai ne_base_auto^sh i f t__pt 8 ( ) ; 

/* set destination_gear_selected from function(s) appropriate for selected.mode 

switchCselected node) 

( 

case REVERSE NODE: 



ff ((foiwd iMt «» TIM) tt 

<dDmli{7tjdtt«y«d ~ FALSI) tt 
(low^spMdJaCdl n FALSE)) 

< 

d»st1n»tion_9«^«stiect«d ■ g«t^auto(natic_gear<destination_gear_s«lected, manual^request) 
dettrwine dSttir^tionO; 

} 

break; 

case LOU.KOOE: 
case HOLD MODE: 
casa NEUTRAL.NOOE: 
case PAftK MOOE: 
case POWER_UP_KOOE: 
case POUER^OOUN HOOE: 
case 0IAGm5sTiOesT_M00E: 

/* prevent transient selection upon mode chanoe (these modes ignore it) */ 

destination_gear_selected • 0; 

breaks- 
default: 

/* invalid mode: do nothing */ 

break ; 

> 

X syncjjer iodic (US PER LOOP); 

> 

x_end_per i od i c ( ) ; 



* Unpubiishtd and conf fdentUl. Not to tm reproduced, 

* dfsseninated. trmf erred or used without the prior 

* written consent of Eaton Corporation. 
• 

* Copyright Eaton Corporation, 1994. 

* Alt rights reserved. 
• 

************************************************************************ 

* Filename: trns act.c96 (R-747) (AutoSplit) 

* Description: 

* This modules monitors and controls the transmission's actions. 
* 

* Part Nuraber: <none> 
* 

* Rev 1.5 12 Dec 1994 09:19 marlcyvech 
In "detertnine_gear" function; added condition for "intent^hold** and 

* "in_gear_swi tch". 

* *" " 

* Rev 1.4 9 Dec 1994 14:25 markyvech 

* In "determine^gear" function; added conditions that the ••g«ar_in_timer" 

* will be held high while in the engine_sync_mode and the intent_to_shif t 

* switch is depressed. (A smaller sync error is maintained for easier 

* lever engagement when the switch is depressed.) Also changed the offset 

* for clearing the low_speed_latch from downshift _point + 100 to 

* downshi f tjDoint + 275. 



* 



* 



Rev 1.3 9 Dec 1994 07:59 markyvech 
In "d€termine_spl i tter_state_autospl i t" function; added the conditions 

* to preselect the splitter if"the "intent_to_shift_switch" is TRUE. 

* — — — 

* Rev 1.2 7 Dec 1994 15:53 markyvech 

* Added the "determin€_range_state" function. Set the appropriate range 

* solenoid select flag based'on the electric range select switch. 
* 

* Rev 1.1 5 Dec 1994 14:54 markyvech 

* Broke the "determine_spl itter^state" function into multiple functions 

* based on the type of base transmission system we are working with. 
* 

* Rev 1.0 3 May 1994 13:35:04 markyvech 

* Initial revision. 
* 

* 

* Header files included. 
* 

#include <exec.h> /* executive information */ 

#include <c_regs.h> /* KR internal register definitions */ 
#include <kr_sfr.h> /* defines the kr special function registers */ 
#include <kr2def.h> /* 80c196kr bits, constants, and structures */ 
#include <wwslib.h> 

#include "drl^cmds.h" /* engine control interface */ 
#include "trra^act.h" interface to this module */ 
#include "trn tbl.h" /* transmission table */ 
finclude "calc_spd.h*« 
#include »cont"sy«.h» 
#include "sel gear.h« 
#include ''conj1939.h« 
#include "pr_s_i_s.h" 

* 

* Variables declared by this file. 
* 

register unsigned char transmission^posi tion; 



unsigned char R747_type; 

unsigned char janined_in_wrong_gear_t imer,- 

unsigned char manual^syfJc^delayed^tiiner; 

unsigned char low_speed_latch; 

unsigned char forward^last; 



migntd dmr 

unsigntd char 
iMlgncd ch«r 
unsigned char 
unsigned char 
unsigned char 
unsigned char 
signed char 
signed char 
signed char 
unsigned int 
unsigned int 
unsigned int 
uns i gned i nt 
unsigned int 
signed int 
signed int 
signed int 
signed int 
signed int 
signed long 
signed long 
signed char 

fpragma EJECT 



splitttr.hl; 

tpiltter.lo; 

rangt^hf; 

range.lo; 

splittar.tiaer; 

spl i ttar^wi thin^sync; 

aux.box; 

downsh i ft.de I ayed; 

g^tr_old; 

current__gear; 

last_known^gear; 

gear^in. timer; 

gear_out_tin>cr; 

no rma I _au t o_neu t ra I _ t i me r 

abs_t r ans_sync_error ; 

t r ans_H i ndow.c ale; 

i nput3speed_inodi f i ed; 

t r ans^sync.er r or ; 

range^error; 

range^cal; 

splitter_tc; 

isdgf; 

gros; 

gjjtr; 



* MtffnM and constants local to th\t fila. 



idefina US PER LOOP 10000U 
#defina JAMMED*! I ME 200 



/* 2.0 SECOHOS */ 



static const 
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static const 
i 
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iHpragma EJECT 



static const uchar SPL(TTER.TC_TAItiC25) « 
< /* Spiitttr Bovtnent 
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/* 


2 *> 


f /• splitter 


m 


overdrive 


*/ 


100. 


/* 


3 *y 


^ /* splitter 


a 


direct 


*/ 


100. 
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/* 


4 *; 


' /♦ splitter 


a 


overdrive 


*/ 


100, 


/* 


5 *> 


f /* splitter 


m 


di rect 


*/ 


100. 
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/* 


6 */ 


f /* splitter 


m 


overdr i ve 


*/ 


100. 
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/* 


7 *y 


' /* splitter 


a 


di rect 


*/ 


100, 


/* 


8 *> 


' /* splitter 


a 


overdrive 


*/ 


100. 

I WW , 


/* 


9 *> 


f /* splitter 


a 


di rect 


*/ 


100, 


/* 


10 *> 


' /* splitter 


a 


overdrive 


*/ 


0, 


/* 


11 *; 










0, 


/* 


12 *> 










0, 


/* 


13 *> 










0, 


/* 


U *> 










0, 


/* 


15 *> 










0, 


/* 


16 *> 










0, 


/* 


17 *> 










0 


/* 


18 *> 











>; 



^pragma EJECT 



* 

* Function: InitiaUzt^Trans^Actton 
* 

* Description: 

* This function initializes those nodule variables that must be set to a 

* know state on power \4> or reset. 
* 

void initialize trans action<void} 
{ 

ge8r_in_timer 3 500; 
9ear~out_ti(ner » 500; 
9_ptr^old a 0; 
current^gear « 0; 
last_known_gear = 0; 
destTnation_gear » 0; 
transmission^posi tion » CXJT_OF_GEAR; 
low_speed_latch = TRUE; 
splitter_To » 0; 
splitter"hi = 0; 
range^lo » 0; 
range^hi « 0; 

normal_8uto_neutral_tin)er » 0; 
dounshlf t_delayed =~FALSE; 
manual_sync_delayed_tirr»er = 0; 
jairmed^in wrong gear timer « JAMMED_TIME; 
R747 type"« INTENT; " 

> 

^pragma EJECT 



* FuKtion: ChecWor_Jaaia»d.G«ar 

* " * 

* Description: 

* This function checks for a indicated engaged gear, (g_ptr), that is different 

* than »destination_geer_selected» and will force the needed conditions to 

* recover. This condition can occur when the transmission is "jaomed" into 

* the wrong lever position, (usually with the clutch disengaged), during a 

* shift. 
« 

void check_for_iammed_gear(void) 



if ((shift_in_process == TRUE) && 
(autofnat ic_sip !- 0) && 
(destination_gear_selected != g^tr) && 
(g_ptr l» 0)"&& 

( jaimjed_in_wrong_gear_timer > 0)) 
j aflined_i n_wrong_gear_t imer- - ; 

if (jammed in wrong gear timer == 0) 
< 

shif t_injwocess = FALSE; 
automat ic_sip - 0; 
desired_gear = current_gear; 
destination_gear = current_gear; 
destination_gear_selected = current_gear; 
jammed in wrong gear timer = JAMMED^TIME; 
engine"coJiinands~= ENGINE RECOVERY; * 
> " 



#pragma EJECT 



* Function: detennin*_9«ar 

* Otscription: 

* This function determine the current gear that the transmission 

* is in. When conditions are such that the current gear can not be 

* determined it will be set to a default, (0). 
* 

* Mote: When the error across the transmission is near zero for sotne 

* time for a given test gear then it will be deemed in that gear. 

* trans sync error = input_spd/gf Cgear] - grtgear] * os 

void determine gear<void) 
< 

idefine BIN 8 256 /* 2 BIN 8 V 

#define MAx"erR 4000 /* RPM */ 

HWefine WINDOW 30 /* 30 RPM */ 

#define GEAR IN TIME LEVER 125 /* 250 MSEC 3 5 cnts per loop */ 

#define GEAR"in"tIME"auTO 50 /* 100 MSEC 3 5 cnts per loop */ 

#define GEAr"0UT TIME 8 /* 80 MSEC */ 

#define MANUAL SYNC DELAYED TIME 45 /* 450 MSEC */ 

#define ERROR FUDGE~FACTOR 3 /* RPM */ 

#define NORMAL_AUTOJIME 250 /* 2.5 SEC */ 

#if (0) 

gj3tr = -1; /* lowest reverse ratio */ 

/** isdgf = input_speed_filtered / front box gear ratio **/ 
bx s (signed int)( input~speed_f i I tered); 
~cx s BIN^S; 

3ax 3 trn"tbl.GF[g_ptr + GR_OFS}; 
asm mul _cxdx, _bx; 
asm div _cxdx, _ax; 
isdgf = _cx; 

/** gros 3 output speed filtered * rear box ratio **/ 

_bx = (signed int)7output_speed_f i I tered ♦ ERROR^FUOGE^FACTOR); 

~cx = trn tbl.GR[gj5tr ♦ GR OFsT; 

"ax = BIn38; 

asm mul _cxdx, _bx; 

asm div "cxdx, "ax; 

gros = _cx; 

trans_sync_error - (isdgf - gros); 
if (isdgf > gros) 

abs_trans_sync_error = (unsigned int)( isdgf - gros); 
else - - " 

abs trans sync error = (unsigned int)(gros - isdgf); 

#endif 

abs_trans_sync_error = MAX_ERR; 
trans^window^calc = 0; 

if (abs trans sync error > trans window calc) /* if not in reverse, check for forward */ 

g j5tr 3 1 ♦ trn_tbl.highest_forward; 
abs^rartBj^yDcJirr^ » MAX^ERR; 

while (Cabs trwts sync^error > trans window calc) && (gjstr !» 0)) 
{ 

gj3tr--; 

/** isdgf = input_speed_f iltered / front box gear ratio *V 
bx s (signed int)( input speed_f i Itered); 
3cx s 8IN_8; 

2ax = trn~tbl.GFCg_ptr + GR^OFS]; 
asm mul _cxdx, _bx; 
asm div "cxdx, 3***' 
isdgf 3 lex; 

/** gros 3 output speed filtered * rear box ratio **/ 

.bx 3 (signed int)(output speed_fi Itered ♦ ERROR_FU0GE_FACTOR); 

"cx a trn tbl.GRCg_ptr ♦ GR OFsT; 

^ax 3 BIN^S; 

asm mul _cxdx, _bx; 

asm div ^cxdx, _ax; 

gros a ^cx; 



trans sync «rror » Isdgf - grot; 
if (iftdgf > grot) 

ate trans sync.error = (intxisdgf - gros); 
•Ist " 

abs.trans_sync_error « (intXgros - isdgf); 

/* calculate trans sync error window based on gear pointer */ 

bx * UINDOU; 
~cx » BIN 8; 

"ax « trn^tbl.GFCg^tr ♦ GR_OFS]; 
asm mulu ~cxdx, _bx; 
asm divu ^cxdx, _ax; 
trans_window^calc » ^cx; 



/* BIN 0 */ 
/* BIN 8 */ 
/* BIN 8 •/ 

/* make UINDOU BIN 8 V 
/* divide by front ration BIN 8 V 
/* BIN 0 V 



if <gj>tr S3 0) /* If in neutral, force values V 

< 

abs_trans_sync_error = HAX^ERR; 
tran8_sync_error « MAX_ERR; 
trans_window_calc = 0; 
isdgf a 0; 
gros 3 0; 

downshift delayed » FALSE; 

jammed in"wrong gear timer = JAMMED TIME; /* Initialize for next occurence */ 

> 

if ((abs trans sync^error > trans_window_calc> || /* Must have error for some V 
(<g_ptr l» current^gear) && (current^gear 0))) /* before neutral state is V 

< " " /* recognized. */ 

if (gear out titner == 0) 

transmissi on-position = OUT_OF_GEAR; 
current gear = 0; 

> 

else 

gear out timer--; 

> 

else 

gear_out_timer = GEAR_OUT_TIME; 



if ((g_ptr != gj3tr_old> || <g_ptr 0) || 

((intent_to_shift_switch TRUE) && 
(in gear switch == FALSE) && 
(engine commands ENGINE SYNC) && 
(shiftjnit^type « MANUAL)) || 

((acceleratorjpedal j50sition < 5) && 
(input speed < 700) M 
(low speed latch FALSE))) 

C 

if ((engine commands == ENGINE.SYNC) || 
(engine'coonands » ENGINE*PftEDIP)) 

if (engine conamds » ENGIMC.PREDIP) 

{ 

norma l^auto^neutral^titaer « 0^ 
marwal'sync^deiayed^timer « 0; 



else 

if (normal_auto.neutral.ticaer <= NORMAL_AUTO_TIME) 
norma l_auto_neut ra l_t imer**; 

if ((shift init type « AUTO) && 

(normal auto neutral_timer < NORMAL.AUTO_TIME)) 
gesr_in_tTmer = GEAR^IN^TIME.AUTO; 
else 

gear.in^timer * GEARJNJIME.LEVER; 



/* intent to shift stuff */ 



if not in gear, init gear in timer. 
Rule out picking a gear when coasting 
down in neutral and no throttle. 
(Found that idle speed and output speed 
/* would match a gear even when in neutral.) 
/* Note: 700 should be idle*>100RPM 



*/ 
*/ 
*/ 
•/ 
*/ 
*/ 



*/ 



Use a short in gear time 
/* for splitter only shifts 

/* unless the system has been */ 

/* in neutral too long. */ 

/* EX: Uhen driver pulls the V 

/* lever to neutral during a •/ 

/* splitter only shift. */ 



else 

if (gear in timer « 0) 



iMt^known 9Mr « 9LP^r; 
traraaission ^^itlon » injmm; 

nortaal auto n«utPtl_ti«ir « 0; /* g^t ready for next tim ♦/ 
dounahlft^delayed « FALS; 

if <<intent_to.shifOHftch == TRUE) && (engine.conmands " ENCINE_SYMC)) 
intent_hoTd » TRUE; 

if (<gos current g«ar > (doitf^shif t^int + 275)) && 
(low"spe€d latch « TRUE)) 

C 

low^speed.latch » FALSE; 

destination_gear » current_gear; 

destination"gear_selected ■ current_gear; 

desired^gear « currant^gear; 

lowest forward » current gear; 
> " 
else 
C 

if (low speed latch « TRUE) 
{ 

destination_gear = I owes t_f or ward; /* was set to 1 */ 

destination~gear_selected"« lowest^forward; /* was set to 1 */ 
desired^gear = lowest_forward; /* was set to 1 */ 

shift in_proces9 = FALSE; 

> 



if (last known gear > 0) /* Record REV/FOR data for •/ 

forward last'* TRUE; /* use in the select_gear */ 

else " /* tnodule. */ 

forward last = FALSE; 

> 

else 

if ((((Shift init type AUTO) || (low speed latch == TRUE) || 
(manual_sync_delayed_timer >= MANUAL_SYNC_DELAYEO_TIME))) && 
(gear_in_t imer >= 4)T 
gear_in_timer -= 4; 

if (gear_in_timer > 0) 
gear_Tn_timer"; 

if (destination gear selected == g_ptr) /* Prevent splitter shift while */ 
downshift^delayed = TRUE; /* stiU confirming a lever shift. */ 



> 



check_f or_jaaii)ed_gear ( ) ; 
gj)tr_old = g_ptr ; 

if (((engine coomands == ENGINE SYNC) || 

(engine~co(nnands == ENGINE FOLLOWER)) && 
(manual Jync_delayed.timer < MAMUAL_SYNC.OELAYED_TIME)) 
manua I ^syr>c^deTayed_t i iner*+ ; 



if (output* speed fUttred < 125> 
i 

current_gear « 0 ; 

transmission jjositloo • OUT_0^_GEA*; 
low_speed^latch » TRlff; 

if (splitter launch state =« LO SPLITTER) 

i 

if ((lowest^forward "2) 11 
(lowest^forward ssa 4) || 
(lowest^forward == 6)) 
lowest forward--; 

> 

else 
{ 

if (dowest^forward « 1) 11 
(lowest*forward "3) || 
(lowest^forward «» 5)) 
lowest forward*^; 

} 

} 



/* manual sync delayed timer is used to allow the sync 
/* mode's"first pass a"chance to pass the engine speed 
/* thru sync and give the mechanicals a chance to 
/* transition. At this time a false in^gear signal 
/* should be avoided. */ 



/* If stopped; set low speed latch */ 



* Function: deterroine^range^status 

* * 

* Description: 

* This function determines the status the of range. 
* 

* rng_err = rear_counter_spd ■ (range_ratio * output^spd) 

* res = 54/21 * 44 * OS (for low range) 

* res = 42/51 * 44 * OS (for high range) 



void determine range $tatus(void) 
< 

#define 81M 12 4096 /* 2 bin 12 V 

#define HI RANGE GEAR 7 

#define LO"ranGE"cal 10532 /* 54/21 BIM 12 */ 

#d€fine HrRANGE^CAL 3373 /* 42/51 BIN 12 V 

#define RAiJGE^UlNDOW_POS 30 /* 30 RPN */ 

#define RANGE"uIM0OW~MEG -30 /* -30 RPM */ 



/*** This code was never tested or used during the concept development ***/ 
/*** phase. However, it is likely to be needed for range protection ***/ 
/*** in the product. ***/ 



if (destination_gear >= HI^RANGE^GEAR) 

range_cal = hT_RANCE_CAl7 
else 

range_cal = LO_RANGE_CAL; 

range_error =<((aux_speed * BIN_12) 

- (range^cal * output_speed_f i I tered))/BIN_12); 

if ((range error > RANGE WINDOW POS) || (range error < RANGE WINDOW NEC)) 

aux_box = OUT_OF_GEAR;~ 
else 

aux_box = IN_GEAR; 



#pragma EJECT 



* Function: detenaint^rtnge^stat^ 
• 

* Description: 

* This function determines the correct state for the range. 
* 

void determine range state<void) 



if (range select switch 

range_lo = OFF; 
range"hi » ON; 

> 

else 
i 

range^lo = ON; 
range hi s OFF; 

> 



== HIGH) 

/* Turn off the low range solenoid */ 
/* Turn on the high range solenoid */ 



/* Turn on the low range solenoid */ 
/* Turn off the high range solenoid */ 



#pragma EJECT 



* 

* Function: dttermirw.splitter^statt.autosplit 

* ~ " . 

* Description: 

* This function determines the correct state for the splitter. 

* Once the transmission is in gear both splitter solenoids are turned off. 
* 

void determine splitter state autosplit(void} 
C 

#define SPLTR SYNC OFFSET POS 80 /* 80 RPM ♦/ 
#define SPLTR"sYNC"oFFSEt"mEG -80 /* -80 RPM */ 
#define SPLITTER tTmE " 20 /* 200 MSEC */ 



if (engine_st8tus == EMGIME_PREOIP_MOOE) /* The splitter_ti«er will keep the 

splitter^tiiner » SPLITTER^TIME; " /* solenoids on for a short time 

else ~ ~ /* once the SYNC mode is entered, 

if (splitter^timer > 0) /* This allows the splitter enough 

splitter^tTroer--; /* time to move, (i.e., when the 

/* splitter changes during SYNC. 



splitter_tc = SPLITTER_TC_TABLECdestination_gear GR^OFS]; 

i nput_speed_mod i f 1 ed = (signed int)( input_speed_f i Itered) + 

( i nput_speed_accel_f i I tered/( 1 000/spl i tter^tc ) ) ; 

if ((input speed modified < (gos signed SPLTR SYNC OFFSET POS)) && 
(input^speed'modif ied > (gos'signed + SPLTR^SYNC^OFFSET^NEG))) 
spiitter_within_sync = TRUE; 
else 

splitter_within_sync = FALSE; 

if ((intent_to_shif t_switch == TRUE) && /* Allows for pre-selection 

(desired_^gear l="dest ination_gear_selected) && /* of the splitter. 

(intent__hold ==» FALSE) M " " 
(automat ic_sip == 0) && 
(shift_init_type == MANUAL) && 
(transJiiission jDosition == IN GEAR)) 

C 

splitter hi = SPLITTER HI TABLE Cdesi red gear + GR^OFS]; 
splitter"lo = SPLITTER"lo~TABLE [desired"gear ♦ GR"ofs3; 



else /* "Normal" splitter control 

i 

if ((splitter^timer > 0) ( | 

((transmissionjwsition " IM^GEAR) 
(shif t^in^rocess == FALSE)) || 

(low_speed_latch « TRUE) || 

(engine^status =» ENG INHERE COVER Y_MOOE) || 

((shift init typ» " MANUAL) M 
(engine.statiM » ENGINE.SYNC.MCDE)) || 

((3hift.init_typ* «» AUTO) U 
(engine.status *« ENGINE^SYHC.MOOE) M 
(splittJr within sync "*TRUE))) 

i 

splitter^hi = SPLITTER^HI.TABLEEdestination.gear ♦ GR 0FS3; 
splitter'lo = SPLITTER"lo"tablE Cdestination"gear ♦ GR"oFS3; 



else 
{ 

splitter^hi = OFF; 
splitter lo « OFF; 

} 

> 

> 

#pragma EJECT 



* 

• Function: d«ter«ine^iplitter_5tate_dual.forc« 

* - - 

* Oescriptlont 

• This function d»teraine« tht correct state for the splitter. 
* 

void determine splitter state dual forceCvoid) 
i 

if ((clutch_state == DISENGAGED) || /* use normal forces V 

(desired gear > 6)) 

i 

splitter_lo = ON; 

> 

else 
( 

if (splitter^select^switch == HIGH) /* use high force into overdrive 

splitter_lo » OFF; 
else 

splitter to ^ ON; 

> 

if (splitter_select_switch == HIGH) 

splitter^hT = ON;" 
else 

spl i tter^hi = OFF; 



fpragma EJECT 



* FcfKtlon: dttarwint^spl ittcr^stat* base 

* Description: 

* This function determines the correct state for the splitter, 
* 

void determine splitter state_base<void> 
i 

splitter_lo = ON; 

if (splitter_select_swi tch == HIGH) 

splitter^hT = ON;" 
else 

splitter^hi = OFF; 

> 

#pragma EJECT 



* 

* Function: detertnine_spiitter_state 

* ~ *" 

* Description: 

* This function determines the correct state for the splitter. 
* 

void determine splitter state<void) 
i 

if <R747_type == 8ASE) 
deterroi ne_spl i t ter_state_base< ) ; 

else 

if (R747_type « DUAL^FORCE) 

determine^spl i tter^state^dual^forceO^- 
else 

determine splitter state autosplitO; 

> 



fpragma EJECT 



* 

* Fuxtfon: T r ansa Uafon^Act ion 

* Description: 

* This fuKtion controls ths states of the system ouput devices. 
* 

void transmission actionCvold) 



initializc_trans^action(); /♦ initialize variables */ 

X startjseriodicO; 

labile (1) 

C 



/* calculate the current gear */ 
/* determine range state */ 
/* determine correct state for range */ 
/* determine correct state for splitter */ 

X sync_periodic(U$ PER LOOP); 

x_end_periodic(); 



determine_gear( ); 
determi ne_r angers t a tus( ); 
determi ne^r angers tateO ; 
deterroine"spl i tter_state( ) ; 



\ 
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DRL_CMDS.C96 
PR_S_I_S.C96 
SEL_GEAR.C96 
SEQ_SHFT.C96 
TRNS ACT.C96 



12/09/94 
12/12/94 
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' Ur^lished and conf idtntlal. Mot to b» reproductd, 

' diss«»inattd, transftrred or used without the prior 

' written consent of Eaton Corporation. 

' Copyright Eaton Corporation, 1993-94, 

' All rights reserved. 



' Filename: drl_cflids.c96 (R-747) (AutoSplit) 
' Description: 

' The functions in this file will pcrfoni the required operations 

' for controlling drivel ine components on the J1939 cooBunication link. 

' Part Murber: <none> 

Rev 1.4 09 Dec 1994 14:29 oarkyvech 
' In function "control_engine_sync**; added code to allow sauiller sync 
' offsets if the intent to shift switch is depressed. This allous easier 
'shift lever insertion. (Note: the gear cannot be confinaed until the 
' switch is released.) 

' Rev 1.3 09 Dec 1994 11:18 markyvech 

* In function "control_enginej5redip"; added code to allow recovery node if 
' the intent switch is^rel eased before neutral is achieved. Also added the 
' pr_s_i_s.h to get the intent_to_shif t^switch variable. Also added a faster 
' torque ranp off rate for manual intent to shifts 

' Rev 1-2 08 Dec 1994 14:44 markyvech 

' Changed the offsets in "control_engine_sync" from +-65 to +-45 RPM. Also 
' changed the input speed filter constant, (IS^FKD, from 236 to 235. 

' Rev 1.1 07 Dec 1994 15:33 markyvech 

' Took out the rear counter shaft speed substitution for output shaft speed 
' because there is no rear counter shaft speed sensor. 

' Rev 1.0 14 Sep 1994 10:48:40 markyvech 
' Initial revision. 



* Header files included. 
* 

********************************************* *«****************«********^ 



#include <exec.h> 
#include <c_regs.h> 
#include <wwslib.h> 
#include "cont sys.h" 
#include "conjT939,h» 
#include "drl cmds.h" 
#include "trn^tbl.h- 
#include "sel"gear.h» 
^include "calc spd.h** 
^include "trns^act.h" 
#include "pr.sj.s.h" 

#pragma noreentrant 

* #defines local to this file. 
* 

#define US.PER_LOOP lOOOOU 

#define ACTIVE_RECOVERY_GEAR 10 /* rule out boosting downs for now */ 
* 

* Constants and variables declared by this file. 



/* executive information */ 
/* ICR internal register definitions V 
/* contains coninon global defines */ 
/* control system information */ 
/* defines interface to jl939 control module V 
/* drivel in* commands information V 
/* transmission table data structures V 
/* access to speed filter values */ 



/• public •/ 



register urmigned char engine^co 
register unsigned chsr engine'status; 

troigned char desired^sync.test.iaode; 

unsigned char forced_p''«d^P? 

unsigned int de3ired_engine_speed_test; 

unsigned int desired^engine^speed^raop; 

unsigned char desired"engine^speed"tioer; 

unsigned char desired*engine_speed^tiaie; 

unsigned char eng_brake_co(nroand; r 

unsigned char eng_brake_assist; 

unsigned char posTtive_pedal_tran8; 

unsigned char sync_first_pas5_t inter; 

/* unsigned char cTutch^stateJ */ 

unsigned int dutches! ip^speed; 

signed int dos_f iTtered; 

signed int overal l^errorj- 
unsigned int os_based_on_rcs; 
unsigned int input_speed_f i Itered; 

signed int dgos; ~ 

signed int input_speed_accel_fi (tared; 

i*isigned int output^speed^f i Itered; 

unsigned long is_f i ltered_bin8; 

unsigned long os^f i itered^binS; 

signed long dis_f i ltered__bin8; 

signed char eng_percent_torque^f i Itered; 

signed char percent_torquc_accessories; 

signed char needed3«''cwit2for_zero_f lywheel^trq; 

unsigned char zero_f lywheel_trq_timer7 

unsigned char zero_f lywheel_trcLtifl»e; 

unsigned char acceTeratorj)edal_position_old; 

unsigned int gos; /* overall destination gear ratio * output speed BIN 0 */ 

signed int gos^signed; /* overall destination gear ratio * output speed SIM 0 */ 

signed int input_shaf t_accel_calculated; 

unsigned int 90S_current_gear; /* overall current gear ratio * output speed BIN 0 */ 

unsigned char sync_f irstjMss; 

unsigned int syncytia i nt a in_timer; 

signed int sync_offset; 

signed int sync"of fset_pos; 

signed int sync_of f set^neg; 

signed int sync_dos_offset; 

signed int sync_dos_of fset_IC1; 

signed int sync~speid_fnodi7ied; 



/* local V 




static 


unsigned 


int 


static 


unsigned 


char 


static 


unsigned 


char 


static 


signed 


char 


static 


unsigned 


char 


static 


unsigned 


int 


static 


unsigned 


int 


static 


unsigned 


char 


static 


unsigned 


int 


static 


unsigned 


char 


static 


unsigned 


int 


static 


unsigned 


int 


static 


signed 


int 



predip^timer^l; 

predip*tiner32; 

predlp^tiaer^S; 

pradi pTt orqua^bi^^va 1 ue; 

predfp'tofqua^b^It in*; 



torque^lioit; 
recovefy_canca I ^t i «er ; 
recov^coast_down^tinp1 ; 
recov^coast^down^tinpZ; 



lpf_output_acctl; 



sync^on.tiBtr; 
sync"of?^tf«»r; 
syncjdi ther^t f ■tr; 



#pragma EJECT 



PREDIP MCDE CONSTAMTS 



idef Ine PREDIP ZERO FOSX TIME 40 

tfdefine PRE01P*T0RQUE lERO TlIC 60 

«define PREOIP*NOftMAL*TIMi 200 

Idcfiae TORQUE_RA«P_0?F.WTE 1 

idefine PREOrP TORQ BUMP VALUE LO 0 

idtfine PREDIP^TORQ^BUMPJIME.LO 15 

idefine PREOIP TORQ BlMP VALUE MED 10 

•define PREDIPIT0Rq"bUMP"tIME_HED 25 

«define PREDIP TORQ BUMP VALUE HI 25 

#define PREDIP T0RQ"8UMP"timE HI 30 




/* OX */ 

/* 0.15s aiOott period V 
/• 10X •/ 

/* 0.258 aiQpn period V 
/* 25X */ 

/* 0.30s dIOms period V 



SYNC MODE CONSTANTS 



«def ine SYNC OITHER TIME ABOVE 

#define SYNC DITHER"time"bELCW 

#define SYNC DITHER RPM ~ 

#define SYNC~01THER~FIRST TIME 



20 /* 0.20s aiOms period */ 

30 /* 0.30s aiOms period V 

35 /* 35 rpm */ 

255 /* DUMMY VALUE */ 



idefine MAINTAIN SYNC TIME 

idefine SYNC FIRST PASS TIME 

idefine THREE PERCENT 

idef i ne ENG_RE SPONSE_UPSH F_T I ME 

idefine ENG"reSPONSE"0NSHF"tiME 

idefine SYNC DOS OFFSET cdilSTANT 



500 


/* 5.00 Sec 


*/ 


250 


/* 2.50 Sec 


*/ 


3 






10 


/* 10 msec 


*/ 


10 


/♦ 10 msec 


*/ 


2816 


/* 11 BIN 8 


*/ 



/** 

* 



RECOVERY MCDE CONSTANTS 



idefine RECOVERY CANCEL TIME 
idefine REC0VERy"canCEL"0FFSET 
idefine RECOVERY"toRQUE STEP 
idefine THLO 0S_ENG DECAY K^ 
idefine THL0"0S ENG~DECAY"rAMP 
idefine THL0"os"fIn7shED DELTA 



10 /* 0.10s aiOms period V 

20 /♦ 20X BIN 0 V 

1280 /* 5X BIN 8 V 
450 

1 /• 1 rpm BIN 0 */ 

200 /• 200 rpm BIN 0 V 



static const uint RECOVERY RATE TABLE (23} » 
< 



0, 


/* 


-4 V 








0, 


/* 


-3 V 








128, 


/♦ 


*2 : O.SOX 




loop 


Bli 8 V 


128, 


/* 


-1 : a,50X 




loop 


BIlTi V 


128, 


/* 


0 : 0.5« 




loop 


ilN 8 V 


128, 


/• 


1 : 0.5QX 


m 


loop 


Bli a V 


128, 


/* 


2 : O.SQK 




loop 


BIK t V 


128, 


/* 


3 : 0.5a 


ptf 


loop 


tIN 8 V 


128. 


/* 


4 : 0.50X 




loop 


Bin i V 


192, 


/* 


5 : 0.75X 


P^r 


loop 


BIM 8 V 


192, 


/* 


6 : 0.75X 


P*r 


loop 


BIK 8 V 


192, 


/* 


7 : 0.75X 


per 


loop 


BIK a V 


281, 


/* 


8 : 1.10X 


per 


loop 


BIN 8 V 


281, 


/* 


9 : 1.10X 


per 


loop 


BIK 8 V 


281, 


/• 


10 : 1.10X 


per 


loop 


BIN 8 V 


0, 
0. 


/* 
/• 


11 V 

12 V 








0, 


/• 


13 V 








0, 


/* 


14 V 








0, 


/* 


15 V 








0, 


/• 


16 V 








0, 


/* 


17 V 








0 


/• 


18 V 









>; 



* Functiom init{«iiz«.dr1v«lin>_clita 
• 

* Description: 

* This fuKtion, calltd after ell resets, uiU initialize the system 

* copy of drivel ine related data received from the coamuni cat ions link. 
• 

static void initialize drivel ine data(void) 
i 

acceierator_pedal_posi tion « 0; 
engine_coainunication_active > FALSE; 
engine^brake^avai labTe * FALSE; 

eng brake coonand « ENG BRAICE !OLE; /* should init with engine.c 
/* cTutch.state = ENGAGED; */ " 
p08itivej3edal_trans * FALSE; 
zero_f lywheel_trq_tiioer » 0; 
2ero_f lywheel^trq^time ■ 0; 
percent_torque_accessories s 3; 

desired_sync_test_mode = FALSE; /* debug use only - delete later */ 
desired'engine^speed^test » 0 ; /* debug use only * delete later V 
desired~engine*speed"rainp = 0 ; /* debug use only - delete later V 
desired"engine_speed__timer = 0; /* debug use only - delete later */ 
desired engine speed > 0; 

sync_dos^offset_K1 = SYNC_0OS^OFFSET_CONSTAMT; 
desi redoing ine_speed_ti we » 0; 
forced _predip = FALSE; 



#pragma EJECT 



Function: control.enalna _predfp 



* Description: 

* Oettnaines throttlt coomand for predip mode. 

* After a reasonable delay for the transmission to pull to neutral the 

* torque mi U be cycled fron zero to a determined value to help the 

* transmission achieve neutral. 

static void control en9inej>redip<void) 
C 

if (engine status !» ENGINE PREOIP NCDE) 

engine^status » ENGINE_PREDIP_MOOE; 

predip^timer^l =0; 
predip"timer*2 « 0; 
predip^timer^S » 0; 

if ((actual engine_pct trq < 5) || (forced_predip timer > 0)) 

predip_tTmerJ ^ PREDIP_NOIlMAL_TIME; 
else 

desired engine _^t trq = actual engine_pct trq; 

> 

engine control TORQUE CONTROL; 
co(nmand_ETC1 = C_ETC1_0VER$PEED; 



if ((intent_to_shift_switch TRUE)) /* Allows for recovery mode if the "intent" syitch */ 
posit ive_pedal^trans » TRUE; /* is released before neutral is achieved V 



if (predip timer 1 < PREDIP NORMAL TIME) 
C 

if ((desired_enginejxt_trq >» TORQUE_RAMP^OFF_RATE) && 
(actual engine jxt trq > 0)) " * ~ 

desired_enginejxt_trq -» TdRQUE_RAMP^OFF_RATE; 

if ((intent to shift switch s« TRUE) U /* faster rate for intent to shift V 
(shiftjnit.type"s= MANUAL) && 
(actuar_enginejxt_trq > 0)) 
desired engine _pct_trq -» 1; 

> 

else 
i 

desired_engine_pct_trq = 0; 

/* check to force bump if neutral not achieved */ 
if (actual engine^pct trq < 10) 
< " " 

if (*+predip timer 3 >■ PREDIP ZERO FOBK TI>«) 
predip tiier 1 « PREDIP NORMAL tTmE; 

> 

♦♦predip timer 1; 

> 

else 

i 

if (((Ipf output accel > -150) || (forcedj)redip timer > 0)) && 

(predip timer~1 < (PREDIP NORMAL TIME ♦ PREDIP TORQUE ZERO TIME))) 

i 

predip torque bcinp time « PREDIP TORQ BUMP TIME LO; 

predip"torque~bunp"value » PREOIP TORQ BUMP VALUE LO + needed^rcent for xero f lywheel.trq; 

> 

else 
i 

if (predip timer 1 < (PREOIP NORMAL TIME + 2*PREDIP TORQUE ZERO TIME)) 
predip.torque_bunp_time = PREOIP TORQ_BUMPJ I MESHED; 

predip torc^ bunp value « PREOIP TORQ BUMP VALUE MED ♦ needed .percent for zero.f lywheet.trq; 
>""" 
else 

i 



prtdfp torqjmjau^^tim « PftOIP.TOM BUMP lim HI; 

pr«dfp~torqM*.bu9.v»(i» « PftEOIP.TGti BUKP VAlIIe HI ♦ nMdtd^rctnt for z«ro fly^Ml trq; 
> - - - - 

} 

if (predip tiner 2 < prtdfp torqut bunp time) 

desired_engine_pct_tpq ■ prod1p_torque_buTp_value; 
if (actual engint^_pct tpq > 0) " 

♦+pred i p_t i tner^l ; 
♦♦pred i p~t i (nep*2 ; 

> 

> 

else 

i 

desired_enQine^t_trq » 0; 
'»^predip_timtr^1; 
♦+preclip ti(Ber"2; 

> 

if (predip_tiinep_2 >= PREDIP.T0RQUE_ZERO_TIME) 
predip_tin>er_2 « 0; 



> 

#pragma EJECT 



* runctloru control.enoirw^tync (AutoSplit) 

* D««cription: 

* This fvretion synchronizes engin* speed to output shaft speed 

* during a shift. 

*#«************«*******«*****«******«************«************«*********^ 

static void control engine sync(void) 
i 

if ((intent to shift switch « TRUE) U /* Intent to shift conditions V 
(shift Tnit type"«» MAMUAL)) /* that allow lower offsets, */ 

i 

8ync_offset ^s « 20; 
8ync"offset neg « -20; 

> " " 

else 
i 

sync_offset^8 ■ 45; /* nortaal AutoSplit offsets V 

sync~offset neg ■ -45; 

> " " 

if (accelerator jDedaljJOsition > THREE PERCENT) 
sync_(naint8in_timer = HAINTAIM_SYNC_TIME; 

if ((engine status 1= ENGINE SYNC HCX)E) || (sync maintain timer » 0)) 

sync_on_timer = 0; 
sync_of f^tiroer « 0; 
sync"f irst_pass » TRUE; 

sync~first j>ass_titner = SYNC_FIRST_PASS_TIME; 

if ((shift^type « UPSHIFT) && (shift_init_type « AUTO)) 

sync_offset * sync^of fset^neg; 
else 

sync^offset = sync^of fset^pos; 

if (engine status !- ENGINE SYNC MODE) /* first time through sync V 

engine.status = ENGINE,SYNC_MOOE; 

if (forced_predip " FALSE) 
sync maintain timer « MAINTAIN SYNC TIME; 

else /* sync maintain timer reached 0 V 

i 

engine control » OVERRIDE DISABLED; 

conmand ETC1 « C ETC1 NORMAL; 



else 

sync_ma i nta i n^t i net - - ; 

if (sync on timers <a 200) /* allow sync mode for about 2 seconds V 
i 

sync.off timer « Of 

engine control > SPEED CONTR(».; 

co(mand_ETC1 • C.ETCl.OVERSPEED; 

if (sync first _pass » TRUE) 

i 

if ((shift type » UPSHIFT) && (shift init type » AUTO)) 
i ' 

sync speed modified * (signed int)(input speed) > 

(ir^t.speed_accerfiltered /(1000/ENG_RESPONSE_UPSHFJIME)); 

if (sync speed modified < gos signed) 

if (sync firstjjass timer ■« 0) 

sync^offset ■ sync^offset j»s; 
aync"first^as ■ FALSE; 

> 

els* 



sync first j»««.tf«»r"; 

> 

> 

else /* shift is a downshift •/ 

C 

sync speed owdified » (signed int)( input speed) ♦ 

(input^speed.acceCfiltered /( 1 000/ EMCJESPONSE^OMSHf .TIME)) 

if (sync speed modified > gos signed) 
i 

/* if (sync first jmss timer 0) V 
/* { " */ 
sync firstjjass = FALSE; 

if (rpct_demand_at_cur_sp < 15) || (shif t_init_type »= MANUAL)) 
sync offset = sync offset neg; 
/* > " " */ 

/* else */ 
/* sync firstjMSS timer--; */ 
> " 

> 

if <gos__signed ♦ sync.offset > 0) 

desired_engine_speed = (int)(gos_signed + sync_of fset); J 
else 

desired_engine_speed = 0; 

> 

else 
< 

if (sync^of f_timer 4) 
sync_of f _t i mer++ ; 

else 
i 

sync_on_timer = 0; 

if (shift_init_type « auTO) 
sync^offset = -(sync^^of fset); /* force sync speed to toggle around gos */ 

else 
i 

sync firstjjass = TRUE; 

sync"firstj3ass_timer = SYNC_FIRST_PASS_TIME; 
sync_offset = sync_of fset jx>s; 

manual sync delayed timer = 0; /* used in SEO SHFT*C96 module */ 

> 

> 

> 

> 

#pragma EJECT 



Faction: control.tngirw_8vnc_tett_«od« (AutoSpl it) 
Description: 

Thit fcixtlon test the synchronize a»de of engine speed control. 



static void control engine sync test node<void) 
C 

if (accelerator^pedaljDosition < 10) 
i 

engine status » ENGINE FOLLOUER.MOOE; 

engine'connands » ENGINE FOCLOUER; 

eng1ne*control - OVERRIDE DISABLED; 

coowand.ETCI ■ C_ETC1_N0RKAL; 

desired'englne speed > 0; 
> " " 

else 
i 

if (accelerator^pedal ^position > 90) 
< 

engine^status « ENGINE_SYNC_MOOE; 
engine^coomands » £NGINE_SYMC; 
engine"control ^ SPEED CONTROL; 
commandJTd * CJTCl^OVERSPEEO; 
desired2engine_speed = desired_engine_speed_test; 
desired~engine~speed timer « desired engine speed time; 

> 

else 
( 

if (d€sired_engine_speed^tiroer > 0) 

des i red_eng i ne_speed_t i mer- - ; 
else 
i 

if (desired engine speed > 600) 

i 

desired_engine_speed_timer « desired_engine_speed^time; 
desired"engine"speed"= (desired engine speed - desired_engine_speed_ra(Bp) 

> 

> 

> 

fpragma EJECT 



^Btf()^^k#ftftftftft4 Aftfti 



r********** ft********************* 



* FiVKtlofu dttenDfn*Jf^rtcov«py_^coBpl«te 

* Description: 

* This routine checks to see if the percent_torque_value_l imi t has 

* exceeded the percent_torque_velue feedback from the engine by xX 

* for X Billiseconds and will~then set percent_torque_value_liinit 

* to 100X to cancel the recovery mode. 

♦ft**********************************************************************/ 

static void determine if recovery_complete<void) 
i 

if ((net engine jxt trq > 10) 

(desired engine_pct trq > (net engine _pct_trq + RECOVERY_CAMCEL,OFFSET))) 

< " " " 
recovery cancel titner; 

> 

else 

recovery^cancel_tiiner = 0; 

if ( (recovery_cancel.tinier >« RECOVERY_CAMCEL_TI>«) || 
(desired engine _pct trq 100) ) 

< " ' 

/* terminate the recovery mode */ 

desired engine_pct trq » 100; 

engine status = ENGINE RECOVERY M(X)E_COMPLETE; 

> 

> 

#pragma EJECT 



* Function: control^tn8ln»_p«eov«ry^nor«Bl 

* OMcrlption: 

* Determine throttle coeaand for recovery mode. 

* TORQiC.lIMlT is seeled as e BIN 8 nunber representing the percentage 

* of torque alloyed to the engine during recovery. 

*♦*♦♦**★*♦♦****♦***♦**♦*«***♦*****♦♦*♦♦*********************************/ 

static void control engine recovery_nonnal(void> 
< 

engine control * SPEE0_TORQUE_LIMIT; 
coomandJTCl « C.ETC1.N0RMAL; 

desired^engine^speed = 8031; /♦ torque limit only, max value for speed */ 
torque^limit RECOVERY^RATE.TABLE Cdestination_gear^4] ; /* BIN 8 •/ 
desired_engine_j)ct_trq » (char)<torque_lirait » 8); /* BIN 0 •/ 
determine if recovery cotnpleteO; 

> 

#pragma EJECT 



FiKtioru control^tfigine.Ptcovery^coastina 
Description: 

Dettrmine throttle coomnd for coasting down shifts mode. 



static void control engina recovery coast ing< void) 

register uint tocal_uint; 

if (sync on timer <= 300) 
i 

♦>sync_on_t i mer ; 

engine_control = SPEED CONTROL; 
coflinand_ETC1 « c_ETC1_N0RMAL; 

sync_off_timer = 0; 

/*« recov__coast_down_tnp1 » gos + (dgos * KD - THLO_OS_ENG.DECAY_RAMP **/ 

if (dgos < 0) /* get absolute value V 

_cx = ( uint) -dgos; 
else 

_cx = (uint)dgos; 

asm mulu cxdx, #THLO OS ENG DECAY K1; /* BIN 12 */ 

asm shrl Icxdx, #12; * " ~ ~ /* BIM 0 */ 

if (_cxdx > 500) /* error check */ 

local^uint = 0; 
else 

local_uint = _cx; 

if (Ipf output accel > 0) 

recov.coast]]down.tinp1 » (gos ♦ local_uint) - THLO_DS_ENG_DECAY_RAMP; 
else 

recov_coast_down.tmp1 » (gos - local_uint) - THL0_0S_EN6_0ECAY_RAItf>; 

/** recov_coast_down_tnp2 « desired_engine_speed - THLO_DS_ENG_OECAY_RAIV 

recov^coast.down_tmp2 = deaired_engine_speed • THL0_DS_EN6_DECAY_RAW; 

if (recov_coast_do«n_tinp1 < recov_coast_down_tmp2) 

desired_engine_speed = recov_coast_down_tmp1 ; 
else 

desired engine speed = recov coast down tfnp2; 

> 

else 

i 

if (sync off timer 5) 
C 

++sync off timer; 

tngine'control « TORQUE CONTftOL; 

conmandJTCI « C.ETCI.NORMAt;^ 

desired'enginejxt trq » 0; 
> " 
else 

sync on timer » 0; 

> 

if ((desired engine speed ^ THLO OS FINISHED DELTA) < gos) 
< 

/* terminate the recovery mode V 
desired engine _pct trq » 100; 
engine status > ENGINE RECOVERY MODE COMPLETE; 
> " 

> 

ipragroa EJECT 



Fimtion: control^engirw^recovtry 
Description: 

This function detenaines uhich type of throttle recovery should be 
used. And initializes some of the variables that will be used. 



static void control engine recovery (void) 
i 

if ((engine status 1^ ENGINE RECOVERY mOB) M 

(engine status !- ENGINE RECOVERY HOOE COMPLETE}} 
i ~ 

engine_status » ENGINE_RECOVERY_MOOE; 

desired_engine_pct_trq « 0; 

recovery_cancel^timer = 0; 

sync^on^timer s 0; 

sync^of f_timer » 0; 

/* reset pedal transition variables */ 
positive_pedal_trans » FALSE; 
posit ive_pedal"trans » FALSE; 
zero_f lywheel_trq^tiroer s 0; 
zero'f lywheel'trq^time » 0; 

if (gos < desired_engine_speed} 
desired_engine_speed = gos; 

/* set initial starting torque limit */ /* percent, BIN 8 */ 
if ((actual_enginejxt_trq > n€eded_percent_for_zero_f lywheel_trq) && 
(pct_demand_at_cur_sp > 5)) 
torque'limit = (TunsTgned int )( actual _enginej)ct_trq ))«8; /* percent, BIN 8 */ 
else 

torque limit = ((unsigned int}(needed j>ercent for zero flywheel trq}}«8; /* percent, BIN 8 V 
} " 

if ((destination_gear > ACTIVE_REC0VERY_6EAR} && 
(pet demand at cur sp < 5) U 
((shift type « COAST OOWN^SHIFT} || 
(shift type == UPSHIFT}}} * 

{ 

control engine recovery coast ing(}; 

> 

else 

{ 

control engine recovery normal (); 

> 

> 

H^ragma EJECT 
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